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Abstract 

This  report  Investigates  forms  of  the  state  noise 
covariance  matrix  In  the  Kalman  Filter.  This  matrix,  de- 
noted 3^,  incorporates  the  effects  of  random  errors  driving 
system  dynamics  Into  the  filter  computations.  The 
matrix  Is  derived  by  Integration  from  the  matrix  of  contin- 
uous time  driving  noise  strengths,  which  normally  includes 
only  diagonal  terms.  This  often  leads  to  use  of  a diagonal 


matrix  with  constant  terms.  However,  the  derivation 
shows  that  should  have  off-diagonal  and  time  varying  terms. 
The  study  Investigates  the  effects  of  including  such  terms 
In  Three  alternate  forms  of  are  derived  for  a speci- 

fic Inertial  navigation  system.  These,  and  a standard  dia- 
gonal form,  are  tested  using  a covariance  analysis.  The 
results  show  little  difference  in  performance  for  the  dif- 
ferent filters.  This  Is  attributed  to  two  primary  factors: 
highly  accurate  external  measurements,  and  the  use  of  inte- 
gration sub- 1 nterval s for  covariance  propagation.  These 
sub- 1 nterva 1 s generate  appropriate  off-diagonal  3^  terms 
when  a diagonal  form  of  is  used  over  each  sub- 1 nterval . 

This  suggests  that  an  appropriate  form  of  non-diagonal  , 
which  would  not  have  to  be  added  In  at  each  sub- 1 nterval  , 
could  significantly  reduce  Kalman  Filter  computation  require- 
ments. Specific  additional  studies  to  test  this  possibility 
are  suggested. 
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STATE  NOISE  COVARIANCE  COMPUTATION  IN  ^HE  KALMAN  FILTER 

I.  Introduction 


Problem  Statement 

The  Air  Force  mission  requires  aerospace  vehicles  with 
highly  accurate  navigation  systems.  To  achieve  the  re- 
quired accuracy,  these  systems  typically  include  two  or 
more  separate  navigation  subsystems.  The  usual  combina- 

I 

tion  consists  of  an  inertial  navigation  system  (INS)  and 
some  external  measuring  device  or  devices  such  as  Doppler 
Radar,  Tactical  Air  Navigation  (TACAN),  a barometric  alti- 
meter, or  a Global  Positioning  System  (GPS)  receiver.  By 
properly  combining  the  information  from  these  different 
measurements,  the  onboard  computer  can  generate  navigation 
data  which  is  more  accurate  than  that  supplied  by  any 
single  instrument  alone.  A widely  used  algorithm  for  com- 
bining this  information  is  the  Kalman  Filter. 

In  theory,  the  Kalman  Filter  is  exactly  defined  by  a 
mathematical  model  which  describes  the  behavior  and  perfor- 
mance of  the  vehicle  and  its  navigation  systems.  This 
"truth  model"  includes  a large  number  (typically  50-100)  of 
individual  variables  or  "states",  including  components  of 
position  and  velocity,  INS  platform  angles,  gyro  drift 
rates,  and  measuring  instrument  biases.  In  most  applica- 
tions, states  such  as  position  and  velocity  exhibit  non- 
linear behavior.  In  order  to  keep  the  truth  model  linear. 
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these  states  are  modeled  as  linear  perturbations  about  a 
known  nominal  path,  These  “error  states"  are  used  In  the 
model  for  this  study. 

In  practice,  a Kalman  Filter  based  on  this  complex 
truth  model  would  require  computer  resources  (memory  space 
and  processing  time)  far  beyond  the  capacity  of  any  airborne 
computer.  Thus,  the  task  of  the  designer  Is  to  Introduce 
approximations  to  the  truth  model  In  order  to  meet  practi- 
cal constraints,  while  maintaining  sufficient  navigational 
accuracy. 

Objectives 

The  purpose  of  this  study  is  to  examine  one  specific 
type  of  approximation  which  Is  widely  used  In  Kalman  Filter 
design.  This  approximation  deals  with  the  computation  of 
the  strength,  or  covariance,  of  the  state  noise  (also 
known  as  dynamic  driving  noise  or  system  noise)  In  the  fil- 
ter computations.  This  noise  determines  how  fast  the  uncer- 
tainty In  the  vehicle  state  increases  between  navigation 
measurements.  In  many  applications  which  use  a discrete 
time  form  of  the  Kalman  Filter,  this  matrix  is  approximated 
as  a diagonal  matrix  with  constant  terms.  Individual  ele- 
ments are  adjusted  for  good  filter  performance  through  a 
tuning  process. 

However,  examination  of  the  truth  model  equations  show 

that  the  state  noise  covariance  matrix  should  include  off- 

diagonal  terms  and  vary  with  the  vehicle  state.  This  study 

attempts  to  determine  the  effects  on  filter  performance  of 

2 


restoring  off-diagonal  and  state  dependent  terms  to  the 
state  noise  covariance  matrix. 


I . 

I . 


Study  Approach 

The  study  tested  several  alternate  forms  of  the  state 
noise  covariance  matrix.  These  matrices  were  assigned  type 
numbers  in  order  of  increasing  complexity.  The  forms 
tested  were: 

Type  I - Diagonal,  with  constant  terms  (standard  type). 

Type  II  - Full  (including  off-diagofial  terms),  but 
still  constant. 

Type  III  - Full,  with  state  dependent  terms  derived 
directly  from  the  truth  model  by  an  approximate 
numerical  integration  technique. 

Type  IV  - Full,  with  state  dependent  terms  analytically 
derived  to  approximate  the  performance  of  the  truth 
model . 

To  evaluate  these  alternatives,  a specific  system  was 
tested.  The  system  chosen  consisted  of  a fairly  typical 
inertial  navigation  system  aided  by  a barometric  altimeter 
and  a GPS  receiver.  The  truth  model  for  the  baro- inert! al 
system  was  developed  by  Widnall  and  Grundy  (Ref  1).  Myers 
and  Butler  (Ref  2)  modified  this  model  to  incorporate  the 
GPS  measurements.  The  filter  model  was  derived  directly 
from  the  truth  model  by  deleting  all  but  the  first  16  of  the 
52  states  (see  Appendix  A).  Kalman  Filters  based  on  each  of 
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the  proposed  noise  matrix  types  were  then  designed. 
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Each  of  the  proposed  filters  was  tuned  to  give  good 
performance  over  a chosen  flight  profile.  The  covariance 
of  the  true  error  In  the  estimation  of  the  primary  naviga- 
tion states  (position  and  velocity  errors)  was  then  com- 
puted for  each  filter.  This  type  of  testing  Is  termed  a 
"covariance  analysis".  The  error  covariance  results  serve 
as  the  primary  criterion  for  comparison  of  the  proposed 
filters.  Another  criterion  Is  the  relative  burden  (number 
of  computations  and  storage  space  required)  which  each 
places  on  the  airborne  computer. 

Assumptions  and  Limitations 

As  mentioned  above,  the  system  tested  in  this  study 
uses  error  states  to  maintain  linear  truth  and  filter 
models.  These  errors  are  modeled  as  linear  perturbations 
to  the  states  about  a nominal  path.  In  order  to  keep  the 
assumption  of  linear  perturbations  as  accurate  as  possible, 
a new  nominal  path  Is  normally  computed  each  time  a measure- 
ment Is  Incorporated.  A Kalman  Filter  using  these  techni- 
ques Is  termed  an  Extended  Kalman  Filter.  This  filter  uses 
the  values  of  the  errors  which  It  computes  for  each  exter- 
nal measurement  to  reset  the  INS. 

The  covariance  analysis  used  to  evaluate  the  filters 
In  this  study  works  In  theory  only  for  a linear  Kalman  Fil- 
ter and  a linear  truth  model.  As  described  In  Chapter  IV, 

It  does  not  supply  external  measurements  which  the  Extended 
Kalman  Filter  could  use  to  compute  a new  nominal  path.  In- 
stead, It  supplies  a precomputed  nominal  path  to  the  filter 
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throughout  the  flight.  Thus,  errors  In  computation  of  the 
nominal  path  by  the  filter  cannot  degrade  the  performance  of 
the  filter  in  a covariance  analysis,  as  they  would  in  actual 
implementation.  Therefore,  the  covariance  analysis  presents 
only  a limited  indication  of  the  performance  of  each  filter. 
This  type  of  analysis  was  judged  to  be  adequate  for  this 
study  for  reasons  given  in  Chapter  IV. 

Several  other  assumptions  and  limitation  are  signifi- 
cant in  this  study: 

1.  It  was  assumed  that  the  Global  Positioning  System 
satellites  always  maintain  the  same  positions  relative  to 
the  aircraft.  The  extra  program  logic  to  propagate  satel- 
lites and  periodically  select  a new  set  for  measurements 
would  have  greatly  increased  computation  requirements  and 
is  not  relevant  to  the  problem  being  studied.  A single 
case  of  satellite  geometry  was  computed  for  a randomly  sel- 
ected time  and  then  used  throughout  the  study. 

2.  The  truth  model  as  obtained  from  the  Air  Force 
Avionics  Laboratory  contains  known  anomalies  in  the  vertical 
channel  (altitude  error,  vertical  velocity  error,  etc.) 
which  can  cause  errors  in  that  channel  to  become  excessive. 
These  errors  were  corrected  by  Intermetrics,  Incorporated 
under  an  AFAL  contract  (Ref  3),  but  the  corrected  model  was 
not  available  in  time  for  this  study.  Some  simple  correc- 
tions were  applied  in  the  Filter  tuning  process  to  obtain 

a workable  model.  Because  of  this  limitation,  vertical 
channel  states  were  not  tuned  and  evaluated  as  critically 


5 


as  horizontal  channel  states  In  the  study. 

3.  Exhaustive  fine  tuning  of  the  filters  was  not  con- 
ducted. No  performance  requirements  are  available  for  the 
filters,  so  it  is  impossible  to  determine  what  performance 
is  "adequate".  The  important  factor  here  is  the  relative 
peformance  of  the  filters  based  on  each  of  the  proposed 
state  noise  computations . This  can  be  evaluated  with  only 
reasonably  good  tuning. 

4.  Numerical  problems  which  often  occur  in  Kalman 
Filters  due  to  finite  computer  wordlength  were  not  considered. 
The  CDC  Cyber  computer  used  for  the  simulations  provides 

very  high  precision  (60  bits),  so  roundoff  and  truncation 
problems  are  not  significant.  This  is  not  the  case  for  an 
airborne  computer,  so  these  problems  would  have  to  be 
studied  for  an  actual  application  of  the  proposed  computa- 
tions . 

Overvi ew 

Chapter  II  of  this  report  presents  the  mathematical 
background  for  the  problem.  Chapter  III  shows  derivations 
for  the  four  models  to  be  tested.  Chapter  IV  describes  the 
testing  method  and  the  test  parameters  which  were  used. 

Chapter  V presents  the  test  results  and  an  analysis  of 
these  results.  Because  the  truth  model  and  filter  model 
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I II.  Theoretical  Background 

Introduction 

This  chapter  presents  the  context  of  the  problem  being 
studied.  It  introduces  the  notation  used  and  the  theoreti- 
cally correct  state  noise  covariance  computation.  Then  it 
discusses  the  need  for  approximate  computations,  and  some 
' available  approximations.  The  specific  approximations  to 

be  tested  are  described  in  the  next  chapter. 

The  purpose  of  this  chapter  is  not  to  derive  the  equa- 
I tions  rigorously,  but  only  to  depict  them  and  explain  their 

context.  The  equations  and  notation  are  taken  from  Refer- 
ence 4,  Chapter  4. 

Kalman  Filter  Formulation 

In  order  to  discuss  the  Kalman  Filter  in  detail,  some 
vector  and  matrix  notation  is  needed.  An  underscored  upper 
case  letter.  A,  indicates  a matrix.  An  underscored  lower 

case  letter,  x,  indicates  a vector.  A matrix  element  is 

depicted  as  an  upper  case  letter  with  Indices  enclosed  in 
parentheses,  e.g.  P{5,  5).  A time  derivative  is  denoted  by 
a dot  above  the  quantity,  e.g.  k.  A superscript  T,  as  in 

A^,  indicates  a matrix  transpose.  A superscript  -1  indi- 

cates a matrix  inverse,  as  in  A'^. 

A nonlinear,  homogeneous  state  differential  equation 
can  be  written  as 

x(t)  « f(x(t),  t]  (1) 


where  x^(t)  is  the  system  state,  including  states  such  as 
position,  velocity,  and  INS  platform  tilt  angles.  It  is 
highly  desirable  to  use  a linear  state  equation  for  a 
filter  if  possible.  In  many  cases,  equation  (1)  can  be 
linearized  by  changing  x to  "error  states".  Then  the 
states  consist  of  linear  perturbations  to  the  above  men- 
tioned states  about  some  nominal  "path",  . A linear 
state  equation  can  then  be  written  for  the  errors  about  the 
nominal  path  by  computing 

3f(x(t),  t] 

5i 

Using  this  form,  a class  of  stochastic  processes  can 
be  described  by  the  continuous  time,  stochastic  state  dif- 
ferential equation 

x(t)  » £(t)x(t)  + B(t)u(t)  + G(t)w(t)  (3) 

where : 

- x(t)  is  the  system  state.  Since  error  states  are 
used  here,  x includes  components  such  as  position  and  velo- 
city errors,  INS  platform  misalignment  angles,  and  measure- 
ment Instrument  anomalies. 

- £(t)  is  the  plant  or  system  matrix,  as  described 
above. 

- B(t)  and  u(t)  are  terms  used  to  incorporate  deter- 
ministic control  inputs. 

- 6(t)  is  a selection  matrix  for  stochastic  driving 
nol ses . 
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- w(t)  Is  a vector  of  zero-mean,  white  Gaussian  noises 
which  drive  the  system. 

External  measurements  are  available  to  the  system  at 
discrete  sample  times.  These  imperfect  measurements,  z, 
can  be  described  as 

z(t^)  = H(t^)x(t^)  + v(t^)  (4) 

where  H is  a selection  matrix  of  the  states  in  the  measure- 
ment and  ^ is  a zero-mean,  white  Gaussian  noise. 

A white  noise  can  be  described  as  a random  process  for 
which  there  is  no  correlation  in  time  between  subsequent 
samples;  i.e.,  the  process  can  go  from  a known  value  at  a 
given  sample  time  to  any  other  possible  value  at  the  next 
sample  time,  no  matter  how  close  together  the  sample  times 
are.  A Gaussian  noise  is  one  whose  joint  probability  dis- 
tributions are  Gaussian.  White  Gaussian  noise  is  character- 
ized by  two  parameters,  the  mean  and  the  "strength": 

E(w(t))  = 0 (5) 

E(w(t)w^(f))  = a(t)5(t-t')  (6) 

where 

E is  the  expectation  operator, 

6 is  the  Dirac  delta  function. 

Thus,  w(t)  is  described  as  a "zero-mean,  white  Gaussian 
noise  of  strength  . Similarly,  the  discrete  time  noise 
^(t)  is  described  by  its  statistics: 
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E(v(t))  « 0 


(7) 


E(v(tp  v{^{  tj ) ) =>  R(t^)  for  = tj 

■ 0 for  f tj  (3) 

Then  v(tp  is  described  as  a "zero-mean,  white  Gaussian 
noise  of  covariance  R". 

In  this  thesis,  the  effect  of  deterministic  control 
inputs  is  ignored,  so  B(t)  and  ij(t)  will  no  longer  appear. 
Because  of  the  driving  noise  w(t),  x(t)  is  a random  process. 
Under  the  assumptions  that  equation  (3)  is  linear  in 
(i.e.,  that  F is  not  a function  of  )^) , w(t)  is  a white 
Gaussian  noise,  and  x(t)  can  initially  be  described  as  a 
Gaussian  random  variable,  it  can  be  shown  that  x(t)  will  al- 
ways remain  Gaussian  (Ref  4:4-22).  These  assumptions  all 
hold  for  equation  (3),  so  the  system  error  state,  x,  is 
modelled  as  a Gaussian  random  variable. 

A Gaussian  random  vector  variable  x is  described  by 
two  parameters  - the  mean,  m^,  and  the  covariance  matrix 
P^.  Heuristically,  the  mean  is  the  average  or  "expected" 
value  of  X,  and  the  covariance  is  a measure  of  the  spread 
of  possible  values  about  the  mean.  For  a Gaussian  random 
variable,  the  mean  value  corresponds  to  the  mode,  or  the 
most  likely  value  of  y.  The  Kalman  filter  uses  the  mean  as 
its  estimate,  denoted  ji.  of  the  state  £. 

When  a measurement  is  processed  in  a Kalman  Filter, 
the  result  is  the  best  obtainable  state  estimate  relative 
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to  a wide  range  of  criteria  (Ref  4:  5-49  to  5-54),  so  the 
covariance  Is  relatively  small.  As  the  vehicle  moves  away 
from  the  measurement  time,  uncertainties  build  up  in  the 
states,  so  the  covariance  grows.  The  filter  propagates  the 

A 

State  estimate,  x,  and  the  covariance  matrix,  £,  forward  In 
time.  When  a new  measurement  is  processed,  the  filter  must 
combine  the  measurement  Information,  z^,  with  the  propagated 

A 

State  estimate,  denoted  x-.  In  effect,  the  filter  computes 

A 

a weighted  average  of  x-  and  using  the  propagated  state 
covariance  matrix  , and  the  measurement  covariance  matrix 
R,  as  weighting  factors.  The  updated  state  estimate  and 

■*'+  4 

covariance  are  denoted  as  x and  . Thus,  there  are  two 
basic  computations  performed  In  a Kalman  Filter:  propaga- 
tion of  the  state  estimate  and  Its  covariance  In  time,  and 
Incorporation  of  a measurement  to  update  the  state  estimate 
and  covariance.  The  time  propagation  equations  are  of  pri- 
mary Interest  In  this  study. 

Propagation  of  the  state  estimate  Is  based  on  equation 
(3).  This  solution  Is  facilitated  through  the  use  of  a 
state  transition  matrix,  defined  by: 

iCt.  to)  " F(t)i(t,  t^)  (9) 

iCtj,,  t^]  « I,  (10) 

where  X the  Identity  matrix.  $(t,  t^)  describes  the 
change  In  the  state  between  times  t^  and  t for  the  homo- 
geneous system.  If  F^(t)  Is  a constant,  then  ^(t,  t^^)  Is  a 
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function  only  of  the  elapsed  time  t-t^,  and  not  of  the 
particular  values  t and  t^.  In  this  case,  Is  often 
written  as  :ll(t-tQ)  or  ^(At). 

Using  this  state  transition  matrix,  the  propagation 
equations  for  the  Kalman  Filter  can  be  derived.  The 
results  are: 

x'{t^)  - l(t^,  t^_j)x'*'(t^_  j)  (11) 

* i(t^,  t^_j)  P'^(t^_j)  i^(t^,  t^_j) 

+ /Ji  i(t.,  t)  G(r)a(T)G^(T)  J(t.  ,T)dT  (12) 

M-1  ’ ’ 

The  equations  for  a measurement  update  use  the  values 
of  P"  and  R to  compute  a gain  matrix,  K,  for  measurement 
time  t^ : 

K(ti)  * £'(t^)H'^(t^)lH(t^)P'(t^)H''’(t^)+R(tpr^  (13) 

This  gain  matrix  Is  then  used  to  compute  the  updated  values 
of  the  state  estimate  and  covariance  as  follows; 


x"  + K(z-Hx~ ) 

(14) 

P'  - K H P' 

(15) 

(The  time  Indices  t^  are  omitted  for  convenience.) 

The  primary  purpose  of  the  filter  Is  to  keep  track  of 

A 

the  state  estimate,  x.  In  order  to  do  this.  It  must  also 
keep  track  of  the  covariance,  £.  As  equations  (13)  and  (14) 
show,  accurate  evaluation  of  P Is  critical  In  computing  the 
state  estimate.  Thus,  proper  evaluation  of  equations  (12) 
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and  (15)  Is  very  Important  In  achieving  good  Kalman  Filter 
performance . 

Kalman  Filter  Implementation 

A typical  truth  model  for  an  aerospace  aided  Interlal 
navigation  system  contains  50-100  states.  Thus,  the 
matrices  of  equations  (3)  to  (15)  are  of  dimensions  as 
large  as  50x50  to  100x100.  The  computer  resources  to  store 
and  manipulate  such  large  matrices  are  simply  not  available 
In  the  airborne  computer.  Many  simplifications  and  approxi- 
mations to  these  models  can  be  made,  often  with  only  a very 
slight  performance  degradation.  Some  of  these  Implementa- 
tion techniques  will  be  discussed  here. 

Of  the  50-100  states  In  the  truth  model,  some  are  more 
Important  than  others.  The  position  and  velocity  states 
are  of  direct  Interest  to  the  user,  since  that  Is  what  a 
navigation  sytem  Is  supposed  to  tell  him.  States  such  as 
gyro  drift  rates  and  accelerometer  misalignments  are  only 
of  Interest  when  they  help  .he  navigation  system  to  obtain 
better  position  and  velocity  estimates.  Many  states  which 
have  only  small  effects  on  navigation  performance  can  be 
combined  or  dropped  from  the  model.  This  simplified  "fil- 
ter model"  typically  contains  10-20  states. 

The  theoretical  and  laboratory  analysis  of  a system 
yields  an  accurate  system  model  In  the  form  of  equation  (3), 
I.e,  Involving  an  matrix  rather  than  a i matrix.  The  Kal- 
man Filter  Is  based  on  the  {^matrix,  which  can  be  derived 
from  F.  The  solution  to  equations  (9)  and  (10)  Is  very 
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F 


time  consuming  to  generate  on  line.  If  the  £(t)  matrix  is 
slowly  varying,  then  for  a ^^t  that  is  small  compared  to  the 
time  constants  of  the  system,  the  solution  to  equations  (9) 
and  (10)  can  often  be  approximated  to  sufficient  accuracy 
by  ♦(t  .+At,  t^ ) = 1 + F(t. )At. 

Using  this  approximation,  equation  (3)  can  be  written 
in  discrete  time  difference  equation  form  (ignoring  deter- 
ministic inputs ) as : 

x(i+l)  = i(i+l,  i)  x(i)  + W^(i)  (16) 

where  i and  i+1  indicate  consecutive  instants  of  time  At 
seconds  apart.  The  w^  term  is  the  discrete  time  equivalent 
of  the  white  Gaussian  driving  noise  w in  equation  '3).  It 
is  zero-mean,  white  Gaussian  noise  of  strength  . The  sub 
script  "d"  serves  to  distinguish  and  ^ from  their  con- 
tinuous time  counterparts.  The  primary  impact  of  this 
change  on  the  Kalman  Filter  equations  is  in  equation  (12). 
which  becomes 

P(i+1)  = i(i+l,  i)  P(i)i^(i+1,  i)  + g^(i)  (17) 

The  first  term  in  this  equation  is  the  same  as  before. 
From  equations  (12)  and  (17),  it  can  be  seen  that. 

9.d(i)  * /^i  T)G(T)Q^(T)G^(T)j;^^(t^  , T)dT  (18) 

The  purpose  of  this  study  is  to  investigate  some  techniques 
for  evaluating  this  term.  From  equation  (17),  it  is 
clear  that  this  term  directly  affects  the  covariance 
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computation,  which  was  seen  to  be  important  for  accurate 
state  estimation  in  equations  (13)  and  (15).  Thus,  numeri- 
cal computation  of  directly  affects  the  performance  of 
the  f i 1 ter. 

A direct  evaluation  of  by  solution  of  equation  (18) 
is  not  appropriate  for  two  reasons.  First,  this  would  pre- 
sent an  excessive  computational  burden  to  the  airborne  com- 
puter. Second,  and  a more  basic  problem,  is  that  this  will 
not  give  a correct  result  for  a reduced  order  filter  model. 
Many  important  states  in  the  truth  model  are  affected  by 
the  driving  noise  only  indirectly,  through  other  states. 

For  example,  the  driving  noise  may  cause  the  position  error 
covariance  to  grow  by  increasing  the  uncertainty  in  velo- 
city, which  is  integrated  to  compute  position.  In  other 
cases,  the  best  available  model  for  a driving  noise  may  be 
a time  correlated  noise.  This  can  be  incorporated  in  equa- 
tion (3)  by  adding  another  state  to  x,  driving  that  state 
with  white  noise,  and  then  driving  other  states  with  that 
state  (this  is  called  a shaping  filter  (Ref  4:4-80)).  When 
such  states  are  removed  to  obtain  the  reduced  filter  model, 
some  sources  of  uncertainty  are  also  removed.  The  direct 
evaluation  of  equation  (18)  to  obtain  in  this  case  would 
model  a time  correlated  noise  as  zero,  which  is  clearly 
1 ncorrect. 

The  designer  compensates  for  this  by  adding  so  called 
"pseudo-noises"  to  the  matrix  in  the  Kalman  Filter. 
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These  are  wh!  a noises  with  strengths  chosen  to  approximate 
the  error  contributions  of  the  discarded  states. 

The  usual  technique  in  Kalman  Filter  design  is  to 
treat  all  of  the  noises  as  independent,  di screte-time 
pseudo-noises.  Thus,  is  approximated  as  a diagonal 
matrix  of  constant  terms,  with  one  entry  for  each  indivi- 
dual state.  Through  some  type  of  performance  evaluation, 
such  as  a covariance  analysis  or  a Monte  Carlo  analysis  as 
described  in  Chapter  IV,  the  designer  tests  and  adjusts  the 
individual  noise  terms  to  obtain  the  best  possible  overall 
performance  from  the  filter.  This  process  is  known  as 
"tuning"  the  filter. 

This  type  of  filter  design  minimzes  the  computational 
burden  of  covariance  propagation,  since  is  precomputed 
and  only  one  number  must  be  storeii  for  each  state.  The  pur 
pose  of  this  study  is  to  determine  whether  some  alternative 
evaluations  can  give  better  navigation  performance  with 
an  acceptable  increase  in  computer  loading.  The  specific 
alternative  forms  for  are  derived  in  the  next  chapter. 
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III.  Proposed  State  Noise  Covariance  Computa 1 1 ons 

Introducti on 

In  the  last  chapter,  the  basic  Kalman  Filter  equations 
were  presented.  The  need  for  an  accurate  state  noise  co- 
variance  matrix,  , was  shown,  and  the  usual  diagonal  form 
of  the  matrix  was  described.  The  purpose  of  this  study  is 
to  evaluate  some  alternatives  to  this  standard  form.  This 
chapter  shows  why  some  different  computations  might  be 
expected  to  give  better  performance.  Then  it  derives  the 
four  types  of  state  noise  matrices  to  be  evaluated.  These 
were  listed  in  Chapter  I in  order  of  increasing  complexity. 
The  type  numbers  assigned  there  will  be  retained,  but  they 
will  be  described  here  in  a more  developmental  order.  The 
full  matrix  with  constant  terms  (Type  II)  is  derived 
from  the  time  varying  types  (Types  III  and  IV),  so  it  is 
discussed  last. 

Need  for  Alternate  S^t a t_e_  Noise  j^o m p u y t i ons 

Recall  the  defining  equation  for  the  discrete  time 
state  noise  covariance  matrix: 

^d^M^  “ ^t|  j ^^^i*  T)G(i)a(i)G^(i)il^(t^  , r)dr  (18) 

The  simplest  approximation  to  this  integral  results  from  a 
first-order,  Euler  Integration  of  equation  (18).  Then  G(t) 
^(t)6^(t)  is  treated  as  constant  in  time  and  ^(t^,  t^_j)  Is 
approximated  as  I^.  Then  is  computed  as  G^G^At.  Thus, 
only  if  GQG^  has  any  off-diagonal  terms  will  have  off- 
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diagonal  terms.  Physically,  this  would  mean  that  the  same 
noise  source  affects  more  than  one  state.  Such  noises  are 
generally  removed  from  a model  by  choosing  the  geometry  of 
the  model  properly  to  avoid  such  direct  noise  correlations. 
Thus,  this  type  of  computation  normally  results  In  a dia- 
gonal matrix. 

A more  accurate  evaluation  of  equation  (18)  can  be  ob- 
tained by  letting  and  possibly  GQn^ . vary  with  time. 
Trapezoidal  integration  can  then  be  used  (Ref  4:6-113)  to 
obtain 

gj(t)  - l/2(i(t+At,  t)G(t)a(t)G^(t)4i^(t  + At,  t) 

+ G(t+At)a(t+At)G^( t+At) ]At  (19) 

In  this  form.  It  can  be  seen  that  even  when  GQG^  Is  a dia- 
gonal matrix,  will  have  off-diagonal  terms  due  to  the 
generally  non- symmetr 1 ca 1 nature  of  the  ^ matrix. 

If  the  first-order  approximation  for  4(t+At,  t)  of 
X+F(t)At  Is  substituted  Into  equation  (19),  the  off-diagonal 
terms  In  can  be  seen  to  come  from  the  F(t)At  term  In 
♦(At).  The  usual  justification  for  omitting  these  off-dia- 
gonal terms  Is  that  the  Integration  step  size  (At)  Is  small 
enough  that  the  contribution  of  the  £(t)At  term  In  equation 
(19)  Is  negligible.  However,  if  the  Integration  step  size 
Is  Increased  (e.g.,  in  order  to  reduce  the  number  of  compu- 
tations required  between  updates),  these  terms  will  become 
more  significant. 
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If  £(t)  is  computed  as  a function  of  a nominal  state, 
(as  in  equation  (2)),  then  the  terms  in  will  also 
be  state-dependent.  Furthermore,  certain  states  in  the 


truth  model  cause  uncertainties  in  other  states  to  grow  at 

different  rates  as  a function  of  the  state.  Some  of  these 

states  are  discarded  in  the  filter  and  replaced  with 

2 

pseudo-noises.  For  example,  g-sensitive  and  g -sensitive 
gyro  drift  rates  cause  the  platform  misalignment  uncer- 
tainty to  grow  as  a function  of  acceleration.  Use  of  a 
constant  value  pseudo-noise  for  such  states  will  either 
overesti mtate  the  uncertainty  in  low  g situations  or  under- 
estimate it  in  high  g situations.  A state  dependent  noise 
matrix  can  compensate  for  this  problem. 

For  these  reasons,  a full,  state  and  time-varying 
matrix  might  be  expected  to  give  a Kalman  Filter  the  capa- 
bility of  achieving  better  navigation  performance  than 
that  obtained  using  the  standard  approximation.  To  test 
this  idea,  three  alternative  forms  for  computation  are 
evaluated  in  this  study.  A standard  type  filter  is  used 
as  a comparison. 

Type  I State  Noise  Computation 

Type  I is  the  standard  state  noise  computation  techni- 
que described  briefly  at  the  end  of  the  last  chapter.  It 
is  included  in  this  study  as  a baseline  for  comparison  for 
the  results  of  the  filters  based  on  other  proposed  state 
noise  computation  types. 
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The  matrix  in  this  filter  is  a diagonal  matrix  with 
constant  terms.  Each  term  in  this  matrix  represents  the 
direct  effect  of  driving  noise  on  one  particular  state. 
These  terms  were  adjusted  to  give  good  overall  performance 
through  a covariance  analysis  program.  This  program  is 
explained  in  the  next  chapter.  Basically,  it  uses  both  the 
truth  model  and  the  filter  model  to  provide  a measure  of 
how  well  the  filter  is  performing. 

Tuning  this  type  of  filter  tends  to  be  an  intuitive, 
trial  and  error  process.  The  designer  may  have  to  trade 
accuracy  in  some  states  for  more  accuracy  in  others.  Since 
the  states  are  highly  interrelated,  it  is  seldom  clear  what 
the  effect  of  changing  one  term  will  be.  In  the  models 
used  in  this  study,  the  most  significant  16  states  (Table 
I)  from  a 52  state  truth  model  (Table  II)  form  the  filter 
model.  Only  four  of  these  states  contain  driving  noise  in 
the  truth  model,  so  12  pseudo-noises  had  to  be  added  and 
tuned.  The  resulting  tuned  matrix  terms  are  listed  in 
Table  III. 

Type  III  State  Noise  Computation 

This  alternative  uses  the  results  of  a trapezoidal 
integration  to  obtain  a more  complete  matrix  directly 
from  equation  (19).  The  G ( t )g^(  t )G^  ( t ) matrix  is  taken 
directly  from  the  truth  model.  This  matrix  is  in  fact  con- 
stant in  time,  so  it  can  be  written  as  ogG^,  The  'J'(At) 
matrix  is  approximated  as  X'''f,(t)At,  using  the  £ matrix  from 
the  truth  model.  For  each  integration  step,  a value  of 
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Table  I 


Filter  Model  Variables 

Basic  Pinson  INS  Error  Model  (East-North-Up  Coordinates) 


1. 

6X  - 

Longitude  Error 

2. 

6L  - 

Latitude  Error 

3. 

6h  - 

Altitude  Error 

4. 

6Ve  - 

East  Velocity  Error 

5. 

6V^  - 

North  Velcolty  Error 

6. 

6Vz  - 

Vertical  Velocity  Error 

7. 

^E  ■ 

East  Component  of  Attitude  Error 

8. 

North  Component  of  Attitude  Error 

9. 

"z  - 

Vertical  Component  of  Attitude  Error 

Altimeter  Error  Model 

10.  e.,,-  Altimeter  Scale  Factor  Error 

/V  h S T 

11.  6 - Vertical  Acceleration  Error  Variable  In 

“ Altitude  Channel 

User  Clock  States  for  the  GPS  Receiver 

12.  6r„  - Clock  Phase  Error 

0 

13.  Sr^j  - Clock  Frequency  Bias 

First  Order  Markov  Model  for  Gyro  Drift  Rates 

14.  DX^  - X Gyro  Drift  Rate 

15.  DY^  - Y Gyro  Drift  Rate 

16.  DZ^  - Z Gyro  Drift  Rate 
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Table  II 


Truth  Model  Variables 


Variables  1-16  are  the  same  as  the  filter  model  variables 
(Table  I). 

G-Sensitive  Gyro  Drift  Coefficients 


17. 

18. 

19. 

20. 
21. 
22. 


DXj 

dyJ 

dyJ 

DZ^ 

DZ^ 


-Sens  1 11 ve 


Gyro 


X gyro  spin  axis  g- sens  1 ti vi ty 
X gyro  input  axis  g-sens 1 ti v1 ty 

Y gyro  spin  axis  g-sensi ti v1 ty 

Y gyro  Input  axis  g-sensi ti vi ty 
Z gyro  spin  axis  g-sensi vi t1 ty 
Z gyro  input  axis  g-sens i ti vi ty 

Drift  Coefficients 


Gyro 


Gyro 


'> 


23. 

°^xv  - 

X 

gyro 

spin  input  gX 
spin  input  g^ 
spin^nput  g 

-sensi ti vi ty 

24. 

DYjy  - 

Y 

gyro 

-sensitivity 

25. 

Scale 

DZ  y - 
yz 

Factor 

Z gyro 

Errors 

-sensi vi ti ty 

26. 

GSF^  - 

X 

gyro 

scale  factor 

error 

27. 

gsfJ  - 

Y 

gyro 

scale  factor 

error 

28. 

GSF^  - 

Z 

gyro 

scale  factor 

error 

Input 

. Axis  Mi  sal i gnments 

29. 

- 

X 

gyro 

mi  sa  1 i gnment 

about  Y 

30. 

XG^  - 

X 

gyro 

mi  sal i gnment 

about  Z 

31. 

YG^  - 

Y 

gyro 

mi sa 1 i gnment 

about  X 

32. 

YG,  - 

Y 

gyro 

mi  sal i gnment 

about  Z 

33. 

- 

Z 

gyro 

mi  sal i gnment 

about  X 

34. 

ZGj  - 

Z 

gyro 

mi  sal i gnment 

about  Y 

Accelerometer  Biases 


35. 

AB^  - X 

accelerometer 

bias 

36. 

AB’',  - Y 

accelerometer 

bias 

37. 

AB^  - Z 

accelerometer 

bias 

Accelerometer  Scale 

Factor  Errors 

38. 

ASF^  - X 

accelerometer 

scale 

factor 

error 

39. 

ASF„  - Y 

accelerometer 

scale 

factor 

error 

40. 

ASF^  - Z 

accelerometer 

scale 

factor 

error 
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Table  II  - Truth  Model  Variables  - Continued 


Accelerometer  Input  Axis  Misalignments 


41. 

X 

accelerometer 

ml  sal  1 gnment 

about 

Y 

42. 

XA^  - 

X 

accelerometer 

ml  s a 1 1 gnment 

about 

Z 

43. 

YA^  - 

Y 

accelerometer 

ml  sal  1 gnment 

about 

X 

44. 

YA^  - 

Y 

accelerometer 

ml  sal  1 gnment 

about 

4. 

45. 

ZA^  - 

Z 

accelerometer 

ml  sal  1 gnment 

about 

X 

46. 

za;  - 

z 

accelerometer 

ml  sal Ignment 

about 

Y 

Barometric  Altimeter  Error 

47.  e - Error  due  to  variation  In  altitude  of  a 
^ constant  pressure  surface. 


Gravity  Deflections  and  Anomaly 


49. 

50. 


Clock  Errors 


51.  6r, 

52.  ir‘ 


East  deflection  of  gravity 
North  deflection  of  gravity 
Gravity  anomaly 


Clock  aging  bias 

Clock  random  frequency  bias 


23 


Table  III 


Values  for  Filter  Type 

Q(l.l) 

2x10"^^  (rad^/sec) 

Q(2.2) 

= 

2x10'^^  (rad^/sec) 

Q{3.3) 

= 

1000  (ft^/sec) 

Q(4.4) 

= 

.01  (ft^/sec^) 

Q(5.5) 

= 

.01  (ft^/sec^) 

Q{6.6) 

= 

.01  (ft^/sec^) 

Q(7.7) 

= 

2.5x10-10  (rad^/sec) 

Q(8.8) 

= 

2.5x10"^°  (rad^/sec) 

Q(9.9) 

= 

2.5x10"^°  (rad^/sec) 

Q(IO.IO) 

= 

4x10"^  (1/sec) 

Q(ll.ll) 

= 

5x10'^  (ft^/sec^) 

Q(12.12) 

400  (ft^/sec) 

Q{13.13) 

= 

1x10"^°  (ft^/sec^) 

Q(14.14) 

= 

5.86x10"^^  (rad^/sec^) 

Q(15,15) 

= 

5.86x10’^°  (rad^/sec^) 

Q(16.16) 

= 

1.62x10"^^  (rad^/sec^) 

The  2^.  matrix  is  obtained  by  multiplying  each  of  the  above 
terms^^by  At  seconds. 
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F(t)  is  computed  for  the  starting  value  of  as  in  equa- 
tion (2),  then  F is  assumed  to  be  only  a function  of  time. 

The  multiplication  of  equation  (19)  to  be  carried  out  is 
then 

aj(t^)  « l/2l(i+F(t^  )At)GgG^(l+F(t^  )At)'^  + G9G''’lAt  (20) 

This  calculation  was  carried  out  for  the  truth  model, 
and  the  upper  left  16x16  portion  of  the  resulting  matrix 
was  retained  for  the  filter.  The  results  of  this  computa- 
tion are  listed  in  Table  IV  (parts  a and  b). 

As  mentioned  in  Chapter  II,  this  derivation  does  not 
account  for  noises  which  are  removed  when  states  are  re- 
moved from  the  truth  model.  Thus,  pseudo-noises  have  to 
be  added  to  the  computed  results  of  Table  IV,  These  pseudo- 
noises have  to  be  tuned  for  best  performance  just  as  in  the 
Type  I filter. 

Note  that  the  only  state  dependent  effect  seen  in 
Table  IV  is  from  the  wander  azimuth  angle,  ct.  This  indicates 
that  in  a fixed  azimuth  system,  a matrix  derived  in  this 
manner  would  be  a function  only  of  At. 

Tuning  of  the  Type  III  filter  should  be  easier  than 
for  the  Type  I because  more  of  the  driving  noise  has  been 
derived  analytically.  This  leaves  only  a few  states  for 
which  pseudo-noises  must  be  added  to  compensate  for  states 
removed  from  the  truth  model.  The  final  values  of  these 
additional  pseudo-noises  are  listed  in  Table  IVc.  Note 
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Table  IV  a. 


Sd 

Values  for  Filter  Type  III 

Derived  Diagonal 

Terms 

Q(3.3) 

= 

Q47-K2.At2 

Q(4,4) 

= 

Qa5*(cos(a)‘At)^+Q2g*(sin(a)*At)^+Q47*At' 

Q(5.5) 

= 

Q25*(sin(a)*At)^+Q2g*(cos(ct)*At)^  + Q4g*At' 

Q(6,6) 

= 

Qa^-At^+Q^^-K^-At^+Qgg-At^ 

Q(7.7) 

= 

U^4*(cos(a)‘At)^+Q^g*(sin(a)*At)^ 

Q(8,3) 

= 

Q^4a(sin(a)*At)^+Q^c*{cos(a)‘At)^ 

Q(9.9)  , 

= 

Ql6-At2 

Q(ll.ll) 

= 

g47.K2.At2 

Q(12.12) 

2*^12'*'^52‘^^^ 

Q(13.13) 

= 

Q52-At2 

Q(14,14) 

= 

2*‘5i4 

Q(15.15) 

2.Q15 

Q(16,16) 

= 

2-Qi6 

where 

- a 1 s 

the 

wander  azimuth  angle  of  the  INS  platform 

- Kj,K2 

.Ka 

are  gains  for  the  third  order  vertical 

channel  model . 

Q Is  the  value  of  Q(n,n)  from  the  truth  model, 
n 
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Table  IV  b. 

Values  for  Filter  Type  III 
Derived  Off-Diagonal  Terms 


0(3,6) 

0(3,11) 

0(4,5) 

= s1n(a) •cos(a) • (035-03^) ‘At 

0(6.11) 

“ -Q47-K2-t:3-it2 

0(7.8) 

= s1n(a)*cos(a)*(0^4-Q^5)*At 

0(7.14) 

= • cos (a ) ‘^t 

0(7.15) 

' ■0i5‘Sln(oi)*At 

0(8.14) 

= 0j4’s1n(ci) ‘At 

0(8.15) 

= 0j5‘COs(a)*At 

0(9.16) 

■ 

0(12.13) 

• Q52-“^ 

Is  symmetric,  so  the  symmetric  terms  must  also  be  added, 
E.g.,  Q(6,3)=Q(3,6) 
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Table  IV  c. 


^ Values  for  Filter  Type  III 
Added  Pseudo-Noises 


Q(l.l) 

3 

4x10"^^ 

Q(2,2) 

3 

4x10"^^ 

Q(3,3) 

3 

Above  term 

+ 

600 

Q(7.7) 

= 

Above  term 

+ 

5x10"^ 

Q(8,8) 

3 

Above  term 

+ 

5x10’® 

Q(9.9) 

= 

Above  term 

+ 

5x10"® 

Q(IO.IO) 

= 

00 

o 

X 

00 

Q(ll.ll) 

3 

Above  term 

+ 1x10" 

Q(12.12) 

3 

Above  term 

+ 

700 

To  obtain  the  final  matrix,  add  the  pseudo-noises  in 
Table  IVc  to  the  computed  terms  in  IVa  and  IVb  and  multiply 
by  At/2. 
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that  only  nine  pseudo-noises  had  to  be  added  in  the  Type  I 
filter. 

Type  IV  State  Noise  Computation 

This  filter  is  based  on  the  work  of  Widnall  (Ref  5, 

Ref  6).  He  derived  values  for  state  dependent,  on-diagonal 
pseudo-noises  based  on  an  analysis  of  the  true  system  equa- 
tions (equation  (3)).  Rather  than  simply  discard  the  ex- 
cess states  in  the  truth  model  when  designing  the  filter 
model,  he  lumped  them  all  under  the  category  of  driving 
noise.  Then  he  determined  the  appropriate  strength  for  a 
single  white  Gaussian  noise  to  simulate  the  result  of 
these  separate  noise  contributions.  For  several  of  the 
states,  this  had  to  be  approximated  in  order  to  assure  that 
the  noise  contributions  added  in  each  integration  step 
would  add  up  to  the  appropriate  amount  of  noise  for  a com- 
plete maneuver.  For  other  states,  the  errors  could  come 
from  several  sources,  so  the  error  source  with  the  largest 
covariance  is  selected.  This  technique  was  used  to  gener- 
ate  relations  for  states  4 through  11,  and  these  are 
1 1 sted  in  Table  V a . 

The  remaining  on-diagonal  terms  were  filled  in  with 
terms  computed  for  the  Type  III  filter  matrix.  An 
examination  of  this  matrix  (Table  IV)  shows  that  many  of 
the  off-diagonal  terms  can  be  computed  as  the  product  of 
the  square  roots  of  the  corresponding  diagonal  elements  and 
a fixed  correlation  factor.  For  the  others,  the  correla- 
tion factor  varies  as  a function  of  the  wander  azimuth 
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Table  V a. 


Values  for  Filter  Type  IV 
Derived  On-Diagonal  Terms 


0(4,4)  = 

2-V-Fs*  (a,^l)^/At  + 2-T 

0(5,5)  = 

2-V-Fs-(a^l)^/At+2*T 

0(6.6)  = 

0(7,7)  = 

0(8,8)  = 

0(7.7) 

0(9,9)  = 

0(7,7) 

0(10,10)= 

^’§17*  ^'^17^^'*’^*^16^^ 
(h'^At) 

0(11.11)= 

(“gn’' 


where : 

V = Path  velocity  at  beginning  of  interval  (ft/sec). 

F = Magnitude  of  the  specific  force  vector  in  the  hori- 
^ zontal  plane  (ft/sec). 

Oj.,  = Largest  standard  deviation  among  3 accelerometer 
^ scale  factor  errors  and  6 gyro  input  axis  misalign- 
ment angles  (8.73x10"^®  rad.)- 

Ouo  = Standard  deviation  of  gyro  drift  coefficient 
”2  (0.3Vhr/g) 

Trr»T-n,T«-,  = Gravity  anomaly  correlation  times.  Computed 
GE  GN  GZ  T =D  /V. 

Dpr.Dpiy.Dp,  = Gravity’^def  1 ecti  on  correlation  distances 
fat  fan  faz  (values:  Dpp=DpM=60,800  ft.),  0^7=364,800  f 


DG£  = DGf^  = 60,800  ft.),  0^2  = 364,800  ft) 


apr,0pM»crr7  “ Standard  devi  ati  ons  .of  gra  vi  ty . def  1 ecti  ons 
fat  fan  fat  (values:  .,8.372x10'^,  5.47x10“^,  and 
1.  127xl0''^ft/sec^) . 

8,g  = l/correl ati on  time  for  barometric  altimeter  bias 
state  due  to  weather  effects  (first  order  Markov 
model).  Computed  as  V/O^^^-j-;  D^|^i-  = 250  n.m. 

o.g  = Standard  deviation  of  altimeter  bias  (500  feet) 

Sr,  = 1/correlation  time  for  altimeter  scale  factor  error 
(1/7200  sec) 

0,7  * Standard  deviation  of  altimeter  scale  factor  error 
(.03) 

At  = Integration  step  size,  seconds 
h = Altitude,  feet 


30 


Table  V b, 

Values  for  Filter  Type  IV 
Terms  Copied  from  Type  III  Filter 


Q(3,3) 

" P47-Ki-4t^/2 

q(12,12) 

q(13,13) 

q(i4,i4) 

“ ‘>14 

q(i5.i5) 

" ‘>15 

q(i6,i6) 

’ ‘>16 

where  terms  are  as  defined  1n  Table  IV  a, 

Pseudo-Nol ses 

Added  for  Tuning 

q(i,i) 

«»  2x10'^^  (rad^/sec) 

q(2,2) 

= 2x10’^^  (rad^/sec) 

q(3,3l 

= above  term+300  (ft^/sec) 

q(i2,i2) 

» above  term  + 350  (ft^/sec) 
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Table  V c 


Values  for  Filter  Type  IV 


Terms  Computed  as  Correlations  of  Diagonal  Terms 


Q(3.6)  = 

QO.ll)  = 
Q(4.5)  = 

Q(6.11)  = 

Q{7.8)  = 

Q(7,14)  = 

Q(7,15)  = 

Q(8.14)  = 

Q(8.15)  = 

Q(9.16)  = 

Q(12.13)  = 
Is  symmetric. 


>/q ( 3 , 3 ) x/qVe.e)  x (ii 
>/q(3,3)  X v/QO  1.11)  X 1-1] 

0 

v^Q  ( 6 . 6 ) X 11,11)  X [1] 

0 

>/Q  ( 7 , 7 ) X v^Q(14,14)  X [cos<a)/v/r] 
>/Q  ( 7 , 7 ) X v/Q(l5,15)  X l-s1n(a)/>/^] 
yQ(8,6)  X yQ(l4.l4)  X [s1n(a)/>/T] 
^0(8,8)  X >/Q{  l5  , l5')  X [cos(a)/v/T] 
>/Q  ( 9 , 9 ) X >/^(l6,16)  X UA/T] 
v^Q(12,12)  X >/Q(13,13)  X [1] 
so,  for  example,  Q ( 6 , 3 ) =Q ( 3 , 6 ) . To 


obtain 


from  the  given  terms,  multiply  each  term  by  At.  (Note: 


the  correlation  factors  given  here  depend  on  the  fact  that 


the  truth  model  driving  noise  terms  Q14  and  Q15  are  equal. 
If  they  were  not  equal,  the  relationship  between  Qj(7,14), 
Qj(7,15),  Qj(8,14),  and  0^(3, 15)  would  be  more  complicated, 
as  can  be  seen  from  the  equations  in  Table  IV). 
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I I 1 1 1 ,1.  HUP«.V 


angle,  a.  For  example, 

Qjj(3,3)  = Q^7-K^-At^-(At/2) 

Qd(6,6)  = Q47-K^-At^-(At/2) 

qd(3,6)  = Q^7-Kj-K2*At2(At/2) 

SO  that  Qj(3,6)  = (3,3)  x ^Q^{6,6) . In  this  case,  the 

correlation  factor  is  1.  Similarly,  Qd(8»15)  = v/Qd (6,6)  x 
v/Qd(  15,15)  X [cos  (a)/^/7]^  so  the  correlation  factor  is 
cos  (a)/  \/T. 

For  the  Type  IV  matrix,  the  off-diagonal  terms  were 
generated  from  the  on-diagonal  values  using  these  derived 
correlation  factors.  These  on-  and  off-diagonal  terms  are 
1 i sted  i n Table  V c. 

This  type  of  filter  still  needs  some  tuning.  The  on- 
diagonal  states  which  were  taken  from  the  Type  III 
matrix  must  be  tuned  as  before.  The  final  tuned  values  are 
listed  in  Table  V.  The  derivation  of  appropriate  values 
has  minimized  the  amount  of  tuning  necessary  for  this 
filter. 

Type  II  State  Noise  Computation 

This  3^d  fnatrix  is  an  attempt  to  incorporate  some  of  the 
effects  of  off-diagonal  terms  derived  above  with  a minimum 
impact  on  the  computational  burden  which  the  Kalman  Filer 
imposes  on  the  airborne  computer.  Thus,  it  includes  only 
constant  terms,  as  in  the  Type  I matrix,  but  adds  off- 
diagonal  terms.  This  change  could  be  implemented  in  an 
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operational  filter  with  only  a few  extra  additions  for  each 
propagation  and  a few  extra  words  of  storage. 

In  the  derivation  of  the  Type  III  matrix,  11  dis- 
tinct off-diagonal  terms  found  (there  are  22  off-diagonal 
terms,  but  is  symmetric,  so  only  11  must  be  stored). 

As  can  be  seen  from  Table  V,  two  of  these  terms  have  cor- 
relation factors  of  zero,  and  two  have  correlation  factors 
of  sin  (a).  Since  these  terms  must  be  constant,  it  is 
necessary  to  select  a reasonable  value  for  a.  In  many 
applications,  a is  set  to  zero  at  the  start  of  a flight, 
and  stays  fairly  close  to  zero,  so  a value  of  zero  was 
chosen  for  a.  This  also  represents  the  effective  value  of 
a for  a fixed  azimuth  INS.  This  causes  the  correlation 
factors  sin  (a)  to  go  to  zero  also,  so  two  more  correlated 
terms  drop  out. 

This  leaves  a total  of  23  parameters  in  the  matrix: 
16  diagonal  terms  and  7 distinct  off-diagonal  terms.  To 
minimize  the  impact  of  these  extra  terms  on  filter  tuning, 
the  off-diagonal  terms  were  not  individually  tuned.  The 
diagonal  terms  were  varied  in  the  tuning  process,  and  then 
the  off-diagonal  terms  were  computed  using  the  correlation 
factors  derived  from  the  Type  III  matrix  (these  are  the 
same  correlation  factors  used  for  the  Type  IV  matrix). 

The  final  values  of  for  filter  Type  II  are  listed  in 
Table  VI. 
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Table  VI  a 


Values  for  Filter  Type  II 

Diagonal  Terms 


Qd.i) 

s 

2x10"^^ 

Q(2.2) 

= 

2x10'^^ 

Q(3,3) 

= 

1000 

Q(4,4) 

s 

.01 

q(5,5) 

= 

.01 

Q(6.6) 

= 

.01 

Q(7.7) 

= 

2.5x10“^° 

Q(8,8) 

s 

2.5x10"^° 

Q(9,9) 

* 

2.5x10"^° 

Qdo.io) 

= 

00 

1 

o 

r— < 

X 

QdMl) 

5x10"^ 

Qd2,12) 

= 

400 

Qd3,13) 

= 

1x10"^° 

Qd4,14) 

= 

5.8x10"^° 

Qd5,15) 

o 

CVJ 

1 

o 

X 

CO 

tn 

Qd6,16) 

= 

1.62x10“^^ 

Units  for  these  numbers  are  the  same  as  those  in  Table  III. 


35 


Table  VI  b. 


Values  for  Filter  Type  II 


Off-Diagonal  Terms 


0(3,6)  « '/(i  ( 3 . 3 ) X n/q  ( 6 . 6 ) x [IJ 

0(3,11)  - V^0(3,3)  X v/o ( 1 1 . 1 1 ) X [-11 

0(6,11)  - >/^(6,6)  X v/()  ( 1 1 , 1 1 ) X [II 

0(7,14)  - yOim  X A(l4,14)  X [IV^l 

0(3,15)  » v^(fe,8)  X >/()(l5,l&)  X [l/y/T] 

0(9,16)  - /irr^TD  X yO'do.lb)  X [IZ/T) 

0(12,13)  > '/oTHTTry  X v/Q(13.13)  X [11 
is  symmetric,  so  for  example,  0(6,3)«Q(3,6) . 
, multiply  each  of  the  above  terms  by  At. 


To  obtain 
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IV.  Evaluation  of  Proposed  Filters 


Introducti on 

Previous  chapters  of  this  report  Introduced  the  Kalman 
Filter,  and  discussed  some  of  the  approximations  and  sim- 
plification techniques  which  are  needed  to  make  It  prac- 
tical. Particular  attention  was  focused  on  the  need  for 
an  accurate  computation  of  the  driving  noise  covariance 
matrix,  . The  defining  equation  was  shown  and  the  usual 
approximation  was  described.  Then  some  alternate  forms  of 
calculations  were  depicted. 

In  order  to  evaluate  these  alternative  computa 1 1 ons , 
some  method  of  assessing  the  performance  of  the  resulting 
Kalman  Filters  must  be  used.  The  best  test  of  a filter  Is 
to  1 mpl ement  it  in  an  airborne  navigation  system  and  gather 
actual  flight  data.  The  cost  of  such  testing  is  very  high, 
so  It  Is  generally  limited  to  providing  final  performance 
verification  of  filters  which  have  already  undergone  exten- 
sive testing.  Thus,  this  study  is  limited  to  the  use  of 
computer  simulations  for  performance  analysis. 

This  chapter  describes  the  testing  process  used  for 
this  research.  It  discusses  the  nature  of  the  computer 
simulation  used  and  the  reasons  for  the  selection  of  that 
type  of  simulation.  It  describes  the  flight  profile  over 
which  the  simulation  was  run,  and  the  different  parameters 
which  were  used  In  testing.  The  test  results  and  analysis 
and  discussion  of  these  results  will  be  presented  In  the 
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next  chapter. 

Covariance  Analysis 

There  are  two  basic  types  of  computer  simulations 
available  for  Kalman  Filter  testing.  They  are  the  covar- 
iance analysis  and  the  Monte  Carlo  analysis.  Both  depend 
on  the  use  of  both  the  truth  model  and  the  filter  Itself 
to  analyze  the  performance  of  the  Kalman  Filter. 

In  a Monte  Carlo  analysis,  the  simulation  run  uses 
the  Kalman  Filter  just  as  it  would  be  used  in  flight.  The 
computer  uses  a random  number  generator  to  generate  the 
driving  noise  for  the  truth  model  and  presents  appropria- 
tely noise-corrupted  external  measurements,  to  the 
filter.  The  filter  generates  a state  estimate,  x,  based 
on  these  measurements.  Then  these  estimates  are  compared 
with  the  true  state  values  generated  by  the  truth  model, 
and  errors  are  computed.  In  order  to  have  some  confidence 
in  the  statistical  accuracy  of  these  errors,  several  runs 
must  be  made  over  the  same  profile  to  get  a statistically 
significant  sample.  Then  the  sample  mean  and  the  covar- 
iance of  the  errors  can  be  computed. 

The  Monte  Carlo  analysis  provides  an  accurate  test  of 
a linear  Kalman  Filter,  or  of  nonlinear  variants  such  as 
the  Extended  Kalman  Filter.  However,  for  a long  flight  pro- 
file, it  takes  an  excessive  amount  of  computer  time  to 
generate  statistically  significant  results.  A faster  simu- 
lation is  possible  for  some  problems  in  the  form  of  the 
covariance  analysis. 


I 
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The  basis  for  the  covariance  analysts  technique  comes 
from  Kalman  Filter  theory  and  linear  system  theory,  Under 
the  assumptions  that  the  truth  model  is  a linear  system 
driven  by  white  Gaussian  noise,  and  the  Kalman  Filter  is 
based  directly  on  the  truth  model,  it  can  be  shown  that 
the  covariance  which  the  filter  computes  for  the  state 
estimate  is  the  same  as  the  covariance  which  the  filter 
commits  In  estimating  the  state.  It  can  be  seen  from 
equations  (12),  (13),  and  (15)  that  this  covariance,  £, 
can  be  computed  for  all  time  without  knowledge  of  the 
values  of  the  measurements  (note  that  ^ does  not  appear  in 
equations  (12),  (13)  and  (15)),  Thus,  the  covariance  ana- 
lysis computes  the  covariance  of  the  error  in  the  state 
estimates  directly.  There  is  not  need  for  random  number 
generators  to  supply  driving  noises  or  for  a large  number 
of  test  runs  to  generate  valid  statistics, 

Practical  Kalman  Filters  are  based  on  a simplified, 
reduced  order  model  of  the  system,  so  the  assumption  that 
the  filter  model  accurately  describes  the  behavior  of  the 
system  is  not  valid.  However,  in  an  off-line  simulation, 
both  the  truth  model  and  the  filter  model  can  be  used.  In 
this  way,  the  actual  errors  committed  by  the  filter  in 
estimating  the  state  can  be  evaluated  (Ref  7), 

Let  the  subscript  "s"  denote  the  system  (truth)  model 
and  "f"  denote  the  filter  model  components,  Then  the  error 
committed  by  the  filter  is  simply  the  difference  between 

'■  If 

the  true  state,  and  the  filter  state  estimate, 


Since  these  states  are  of  different  dimension,  this  is 
wri tten : 


e(t)  = ^^(t)  - Tx^  (t)  (21) 

where  e is  an  error  vector  and  T is  a transformation  matrix 
from  the  true  state  to  the  filter  state.  A common  for 
T is  [1:0]^,  indicating  that  the  filter  contains  the  first 
n states  from  the  truth  model.  The  equations  for  propa- 
gating and  updating  the  covariance  of  this  error,  P^,  can 
be  derived  just  as  equations  (12),  (13),  and  (15)  were  de- 
rived for  the  covariance  estimate  in  the  filter,  P^. 

For  the  special  case  in  which  the  models  contain  only 
error  states  and  an  impulsive  control  is  available  to  reset 
all  of  the  estimated  errors  to  zero  for  each  measurement, 
these  covariance  equations  have  an  especially  convenient 
form.  In  this  case,  the  error  covariance,  P ^ , satisfies  the 
same  equation  as  the  system  covariance,  P^.  The  time  pro- 
pagation equation  for  P^  is  equation  (12)  or  (17).  In 
practice,  the  gain  matrix  computed  by  the  filter,  K^,  will 
be  used  to  update  the  state  estimate,  so  it  must  be  used  to 
update  the  truth  model  covariance.  Thus,  for  a covariance 
analysis,  the  Kalman  Filter  being  tested  must  be  used  to 
compute  the  gain  matrix  through  equations  (12),  (13),  and 
(15).  Since  K^  is  not  the  same  as  the  theoretically  optimal 
gain  which  a filter  based  on  the  truth  model  would  compute, 
the  update  equation  for  P^  must  be  modified  from  the  form 
of  equation  (15).  The  result  is; 
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(22) 


Thus,  by  using  both  the  truth  model  and  the  filter 
model,  the  covariance  of  the  true  errors  committed  by  the 
filter  in  estimating  the  state  can  be  computed  through  the 
use  of  equations  (12),  (13),  (15),  and  (22).  Note  that 
there  is  still  no  dependence  on  the  specific  measurements 
^(t^)  which  the  filter  would  receive.  Therefore,  it  is 
still  possible  to  compute  directly  the  covariance  of  the 
error  in  the  state  estimate  in  a single  simulation  run. 

The  covariance  analysis  has  several  limitations.  It 
computes  only  the  covariance  of  the  errors,  ignoring  their 
mean  value.  By  the  nature  of  its  equations,  sign  errors  in 
the  filter  model  matrices  can  go  undetected.  The  most  ser- 
ious limitation  is  that  a covariance  analysis  is  theoreti- 
cally correct  only  for  linear  Kalman  filter  and  truth 
models. 

As  described  in  Chapter  I T,  the  filter  in  this  study  is 
not  strictly  linear,  but  rather  is  an  Extended  Kalman  Fil- 
ter, which  is  linearized  about  a nominal  path,  In 

actual  use,  a new  nominal  path  would  be  computed  after  each 
measurement  incorporation.  However,  in  a covariance  ana- 
lysis, there  are  no  measurements  available.  Inf orma ti on 
about  some  nominal  path  is  supplied  to  the  filter  by  the  | 

covariance  analysis  program,  but  there  is  no  way  to  assure 
that  the  filter  estimates  would  actually  stay  near  this  no- 
minal path. 
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In  a covariance  analysis,  the  state  dependent  terms  In 
the  model  are  always  based  on  the  nominal  state,  x^- 
line  use,  these  terms  must  be  based  on  the  estimated  state, 

A 

X.  The  difference  between  these  two  values  of  x can  cause 
the  £(t)  matrix,  as  evaluated  in  equation  (2),  to  vary  signi- 
ficantly between  the  covariance  analysis  tests  and  on-line 
application.  Thus,  a filter  that  works  well  in  a covariance 
analysis  may  perform  less  well  in  actual  use. 

For  this  reason,  a covariance  analysis  usually  plays  a 
limited  role  in  the  development  of  a Kalman  Filter.  It  is 
usually  used  for  tuning  because  of  its  faster  run  time. 

Once  this  tuning  is  completed,  the  filter  is  tested  in  a 
more  accurate  way  (Monte  Carlo  analysis  and/or  flight 
testing)  to  assure  proper  performance.  The  covariance  ana- 
lysis results  are  viewed  as  a limited,  initial  indication 
of  performance. 

In  this  study,  a covariance  analysis  is  used  because  of 
computer  time  considerations.  Thus,  the  results  presented 
are  limited  by  the  problems  noted  above.  However,  the  in- 
tent of  this  study  is  to  evaluate  the  relative  oerformance 
of  the  proposed  Kalman  Filters.  Since  the  filters  differ 
only  in  the  computation  of  the  driving  noise  covariance 
matrix,  nonlinearities  and  other  unseen  effects  in  the 
covariance  analysis  are  likely  to  be  approximately  the  same 
for  all  of  them.  Thus,  the  covariance  analysis  provides  a 
valid  method  for  the  required  performance  analysis'. 
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The  covariance  analyses  for  this  study  were  run  using  a 
computer  program  supplied  by  the  Air  Force  Avionics  Labora- 
tory known  as  the  General  Covariance  Analysis  Program  (GCAP) 
(Ref  7).  This  program  provides  utility  subroutines  for 
storing  and  manipulating  the  truth  model  and  filter  model 
matrices,  covariance  matrices,  Kalman  gain  matrix,  and  so 
on.  The  user  supplies  subroutines  to  read  in  his  input 
data,  compute  a nominal  path,  and  compute  the  components  of 
his  truth  model  and  filter  model  matrices. 

The  GCAP  program  propagates  the  covariance  In  time 
through  the  use  of  a continuous  time  differential  equation 
of  a different  form  from  equation  (12): 

P.(t)  = F(t)P(t)  + P(t)F‘'’(t)  + G(t)g(t)G^(t)  (23) 

This  equation  has  the  same  solution  as  equation  (12),  so 
the  results  of  this  equation  are  valid  for  the  current 
study.  The  GCAP  program  Integrates  P(t)  given  in  equation 
(23)  using  a fourth-order,  Runge-Kutta  integration  routine. 
This  routine  computes  new  values  of  £(t)  and  G( t )^( t )G^( t ) 
at  the  beginning,  middle,  and  end  of  each  Integration  step. 
Thus,  this  routine  provides  a more  accurate  numerical  pro- 
pagation of  the  covariance  than  equation  (12)  for  the  same 
integration  step  size. 

Equation  (23)  causes  a problem  for  this  study,  It  re- 
quires a value  for  Q.(t),  but  the  study  Is  testing  forms  for 
the  more  commonly  used  j^(t).  Thus,  the  propagation  of  ^he 
filter  covariance  Is  separated  Into  two  parts.  The 


homogeneous  part  is  computed  using  equation  (23)  with  Q(t) 
set  to  0.  Then  the  effect  of  the  driving  noise,  0^,  is 
added  to  this  result.  This  calculation  is  liore  representa- 
tive of  the  type  of  calculation  used  in  on-line  Kalman  Fil- 
ter applications  than  a direct  integration  of  equation  (23). 
A direct  evaluation  of  (23)  is  used  for  the  truth  model  to 
provide  greater  accuracy. 

The  GCAP  program  provides  the  needed  calls  to  a user- 
supplied  subroutine  (TRAJ)  to  generate  the  nominal  path,  x^. 
Then  it  calls  another  subroutine  (FLTMAT  or  SYSMAT)  to  com- 
pute the  values  of  the  filter  or  truth  model  matri'<  elements 
for  that  value  of  x^.  These  matrices  are  then  used  for  co- 
variance  propagation  and  updating.  The  basic  sequence  is 
as  follows: 

1.  Initialize  mat r i ces . 

2.  Compute  the  nominal  state,  x^ . 

3.  Compute  linearized  filter  matrices,  F^  and 

4.  Propagate  the  filter  covariance  matrix,  P^,  one  in- 

tegration step  forward  in  time  (i.e.,  integrate  equa- 
tion (23)  with  ,(l(t)“0  for  one  integration  step,  then 
add  ) ) • 

5.  Repeat  steps  2-4  until  it  is  time  for  a measurement 
update. 

6.  Compute  matrices  and  R^. 

7.  Compute  a Kalman  gain  matrix,  K^,  using  equation 
(13).  Use  this  gain  matrix  to  update  P^. 
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8.  Repeat  steps  2-6  using  the  truth  model  matrices, 

£5 » ’ -s’  -s’  true  error  covariance  ma- 

trlx  Pg.  (Use  equation  (23)  directly  in  step  4.) 

9.  Use  the  Kalman  gain  matrix  computed  for  the  filter, 

K,,  to  update  the  true  error  covariance  matrix,  P , 

— T — e 

using  equation  (22). 

10.  Repeat  steps  2-9  until  the  specified  stop  time  is 
reached. 

The  true  error  covariance  matrix,  represents  the 
covariance  of  the  error  committed  by  the  filter  in  esti- 
mating the  state.  The  program  provides  facilities  for 
plotting  both  the  filter  covariance,  P^,  and  the  true  error 
covariance,  This  plotted  output  provides  a convenient 

form  for  presenting  test  results,  and  in  fact  will  be  used 
for  this  purpose  in  the  next  chapter. 

Test  Parameters 

As  mentioned  above,  the  GCAP  program  provides  calls  to 
a subroutine  to  generate  a nominal  path,  x^.  For  this  study, 
the  subroutine  simply  reads  values  for  x^  from  a file  gen- 
erated by  an  external  program.  The  external  program  used  is 
called  the  Profile  Generator  Program,  or  PROFGEN  (Ref  8). 

This  program  generates  parameters  such  as  position,  velo- 
city, attitude  angles,  and  specific  force  vectors  for  an 
aircraft  traversing  a specified  flight  path.  The  user 
specifies  the  maneuvers  he  wishes  the  aircraft  to  perform: 
turns,  pitches,  climbs,  dives,  path  accelerations,  etc.  In 
addition,  he  specifies  certain  aircraft  performance  factors, 


such  as  maximum  roll  rate.  The  program  can  simulate  a wide 
range  of  maneuvers  and  gives  very  accurate  computed  values 
of  the  vehicle  parameters. 

wo  factors  in  the  study  affected  the  type  of  flight 
profile  selected.  In  order  to  show  the  benefits  of  slate 
dependent  terms  in  the  noise  matrix,  a flight  profile  with 
large  changes  in  dynamics  such  as  velocity,  specific  force, 
and  altitude  was  desired.  This  suggests  a profile  typical 
of  a high  performance  aircraft,  involving  high  and  low 
flight,  high-g  turns,  straight  flight,  and  so  on. 

The  second  factor  in  profile  selection  is  the  integra- 
tion step  size.  Small  integration  steps  provide  more 
accurate  integration,  but  greatly  increase  the  computational 
burden  of  the  Kalman  Filter.  Normally,  the  designer  must 
minimize  this  computational  burden,  so  he  would  like  to 
use  as  large  a stepsize  as  possible.  The  stepsize  must  be 
small  enough  to  allow  a sampling  frequency  at  least  twice 
as  high  as  the  frequency  corresponding  to  the  fastest  error 
state  dynamics  in  the  model,  in  order  to  avoid  aliasing  pro- 
blems. From  the  viewpoint  of  computational  burden,  it  is 
desirable  to  use  a stepsize  as  near  this  limit  as  possible 
while  maintaining  sufficient  accuracy. 

From  the  derivation  in  Chapter  III,  it  can  be  seen  that 

the  off-diagonal  terms  in  the  proposed  matrices  are  pro- 
2 

portional  to  At  , while  the  on-diagonal  terms  and  pseudo- 
noises are  proportional  to  At.  Thus,  if  At  is  small,  the 


off-diagonal  terms  will  be  significantly  smaller  than  the 
on-diagonal  terms,  so  the  approximation  of  setting  the  off- 
diagonal  terms  to  zero  is  justified.  However,  as  At  is  in- 
creased, the  magnitude  of  the  off-diagonal  terms  increases, 
so  for  a large  At,  they  become  significant. 

Furthermore,  as  the  integration  step  size  is  reduced, 
more  of  these  smaller  integration  steps  must  be  computed. 

The  process  of  integrating  equation  (23)  and  then  adding 
is  repeated  several  times  between  updates.  Integration 
of  equation  (23)  after  has  been  added  for  the  previous 
integration  step  causes  off-diagonal  terms  to  be  computed 
for  £ even  when  is  diagonal.  Thus,  to  show  the  effects 
of  including  off-diagonal  terms  in  the  matrix  most 
clearly,  a large  integration  stepsize  is  desired. 

The  flight  profile  chosen  for  this  study  consists  of  a 
representative  combat  flight  for  an  F-4  aircraft.  The  in- 
puts to  the  PR0F6EN  program  split  the  flight  into  segments. 
For  each  segment,  the  desired  maneuver  is  specified.  The 
maneuvers  specified  for  the  flight  used  for  this  study  are 
1 1 sted  i n Table  VII. 

For  this  flight  profile,  an  integration  stepsize  of  2 
seconds  was  selected.  This  stepsize  was  found  to  give 
accurate  tracking  of  the  error  state  dynamics.  Larger  inte- 
gration stepsizes  were  found  to  cause  numerical  problems  in 
the  6CAP  program  which  caused  the  covariance  matrices  to 
have  negative  terms  on  the  diagonals.  This  effect  appears 
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Table  VII  a. 

Flight  Profile  for  Test  Cases 
Initial  Conditions*: 


Time  = 

4728 

seconds 

Velocity  = 

934.8 

ft/ sec . 

Heading  = 

91.6  deg. 

Pitch  Angle  = 

-2.04 

deg . 

Latitude  = 

42.43 

deg . 

Longitude  = 

-72.25 

deg.  (72.25  deg.  West) 

Altitude 

17,743 

.4  feet 

▼ 


♦NOTE: 

j so  the 

listed 

I 

actual 


i 

I 

i 


This  profile  starts  in  the  middle  of  a longer  flight, 
initial  conditions  are  not  round  numbers.  The  times 
here  will  be  seen  on  the  plotted  output,  so  the 
times  are  listed  rather  than  elapsed  times. 


I 

I 


to  be  caused  by  the  rapidly  changing  dynamics  of  the  chosen 
flight  profile. 

O 

Clearly,  for  a stepsize  of  2 seconds.  At  is  not  small 
compared  to  At,  so  this  stepsize  should  provide  a good  test 
for  the  proposed  alternative  state  noise  covariance  compu- 
tations. To  provide  a comparison,  the  filters  were  also 
tested  with  an  integration  stepsize  of  0.2  seconds.  The 
filters  would  have  to  be  retuned  to  give  the  best  obtain- 
able performance  with  this  value  of  At.  However,  the  com- 
puter cost  for  these  runs  was  relatively  high,  so  this  was 
not  done.  Instead,  the  filters  were  retested  using  the 
matrix  values  listed  in  Table  III  to  VI,  solely  to  provide 
a basis  of  comparison  for  the  longer  integration  stepsize 
runs. 

The  external  measurements  available  to  the  filter  are 
provided  by  a Global  Positioning  System  (GPS)  receiver. 

This  system  consists  (when  it  becomes  operational)  of  a set 
of  24  satellites  evenly  distributed  in  three  orbital  planes 
The  position  of  each  satellite  is  known  very  accurately, 
and  each  broadcasts  a very  accurately  timed  sequence  of 
pulses.  By  measuring  the  time  delay  between  these  pulses 
and  pulses  generated  by  an  onboard  clock  which  is  synchron- 
ized with  the  satellite  clocks,  the  position  and  velocity 
of  the  receiver  can  be  measured  very  accurately.  Errors  in 
the  onboard  clock  cause  inaccuracies  in  the  measurement  in 
the  form  of  a range  bias  and  a range  rate  bias.  To  reduce 
these  errors,  extra  "user  clock"  states  to  model  the  biases 

i 
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Table  VII  b. 

Flight  Profile  for  Test  Cases 


Segment  Time 

Acti on 

1 

4723- 

4733 

Pitch  down  to  -6.54  deg.  and  decelerate 
to  844.7  ft/sec. 

2 

4733- 

4769 

Descending  right  360  deg.  4.5  g turn. 

3 

4769- 

4805 

Descending  left  360  deg.  4.5  g turn. 

4 

4805- 

4815 

Pitch  up  to  +1.56  deg.  (Altitude  at  end 
= 10586  ft.  ) 

5 

4815- 

4915 

Sinusoidal  heading  changes,  14.4  deg/sec, 
climb  to  12,886  ft. 

6 

4915- 

5095 

Sinusoidal  heading  changes,  12  deg/sec, 
maximum  yaw  = 15  deg,  clin,^  to  17,025  ft. 

7 

5095- 

5110 

Climbing  1 g 5 deq.  right  turn,  climb  to 
17  ,370  ft. 

8 

5110- 

5135 

Pitch  to  level  flight,  climb  to  17,386 
ft. 

9 

5135- 

5140 

Straight  flight.  Ends  at  Lat.  = 42.34 
deg.,  Lon.  = -71.21  deg.,  Alt  = 17386  ft. 

10 

5140- 

5142.5 

1 g,  2 deg.  right  turn. 

11 

5142.5- 

5168.5 

Pitch  down  to  -45  deg.,  descend  to  9127 
ft. 

12 

5168.5- 

5173 

Continue  descent  to  6439  ft. 

13 

5173- 

5178 

Descending  0.5  g 30  deg.  right  turn,  de- 
scend to  3452  ft. 

are  added  to  the  baro^inertial  system  model  used  in  the 
filter. 

For  this  study,  it  is  assumed  that  four  satellites  are 
continuously  in  view  in  a fixed  location  with  respect  to 
the  aircraft,  and  both  range  and  range  rate  measurements  are 
available  from  each  satellite  (this  is  somewhat  different 
from  the  way  the  actual  system  will  work,  but  the  difference 
is  not  relevant  to  this  study).  To  be  realistic,  the  simu- 
lation should  account  for  the  fact  that  the  satellites  move. 
It  should  propagate  them  in  time  and  optimally  select  a new 
set  of  them  for  measurements  at  regular  intervals.  However, 
the  program  logic  to  do  this  is  fairly  complex  and  time  con- 
suming, and  has  no  bearing  on  the  issue  of  alternative 
evaluations.  Therefore,  the  observation  geometry  matrix, 
H(t),  was  computed  once,  using  satellite  geometry  for  a ran- 
domly chosen  time  and  location.  Then  this  H matrix  was 
assumed  to  be  constant  throughout  all  test  runs. 

Measurements  were  presented  to  the  filter  every  10  se- 
conds. This  update  interval  was  chosen  as  a fairly  repre- 
sentative value  of  the  update  intervals  used  in  typical 
high  accuracy,  aided  inertial  navigation  systems. 

Kalman  Filters  for  each  of  the  proposed  matrices 
were  coded  in  the  appropriate  form  for  the  SCAP  program. 

Then  a covariance  analysis  was  performed  for  each  one,  using 
the  parameters  described  in  this  chapter.  The  results  of 
these  tests  are  presented  and  discussed  in  the  next  chapter. 
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V Results  and  Discussion 

Introduction 

Previous  chapters  have  i nt reduced  the  problem  to  be 
evaluated  in  this  study.  The  notation  used  and  the  mathe- 
matical formulation  of  the  Kalman  Filter  were  presented  in 
Chapter  II.  The  need  for  approximate  computations  in  order 
to  achieve  practical  on-line  implementation  was  shown.  In 
Chapter  IV,  some  specific  methods  for  evaluating  the  state 
noise  covariance  matrix,  were  derived.  The  methods 
used  for  testing  Extended  Kalman  Filters  based  on  these 
covariance  matrices  were  described  in  Chapter  IV. 

This  chapter  presents  the  results  of  the  testing  for 
filters  based  on  the  four  proposed  matrices.  The  test 
results  are  shown  in  both  graphical  and  tabular  form.  These 
results  are  discussed  and  analyzed,  and  suggestions  for  fu- 
ture studies  are  made. 

Test  Results 

The  results  of  the  covariance  analysis  testing  are  pre- 
sented in  Figures  1 to  48.  These  plots  present  the  square 
root  of  the  estimation  error  covariances  of  the  state  vari- 
ables listed.  This  "one-sigma"  value  of  the  error  in  the 
state  estimate  gives  a description  of  the  expected  error, 
in  that  68%  of  the  errors  will  be  less  than  or  equal  to  this 
value.  99.8%  of  all  errors  will  be  less  than  or  equal  to 
three  times  this  one-sigma  value.  All  error  states  are 
assumed  to  have  a mean  value  of  zero. 
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The  variables  plotted  are  Longitude  error.  Latitude 
error.  Altitude  error,  and  East,  North,  and  vertical  com- 
ponents of  velocity  error.  For  each  of  the  filters  tested, 
two  plots  are  shown  for  each  variable.  The  first  of  these 
is  labeled  "FILTER"  and  depicts  the  covariance  computed  by 
the  filter  for  each  state  estimate.  The  second  plot  is 
labeled  "SYSTEM"  and  depicts  the  true  error  covariance  com- 
puted by  GCAP  using  the  truth  model  system  matrices  and  the 
Kalman  gain  matrix  from  the  filter. 

One  set  of  plots  is  shown  for  each  of  the  proposed 
filters.  Recall  that  these  filters  differ  only  in  the  form 
of  the  state  noise  covariance  matrix,  : 

Type  I - Qj  is  a diagonal  matrix,  with  constant  terms. 

Type  II  - is  a full  matrix,  with  constant  terms. 

Type  III  - i s a full  matrix,  with  varying  terms  de- 

rived by  a trapezoidal  integration  of  the 
defining  integral  (equation  (22)). 

Type  IV  - is  a full  matrix,  with  terms  which  vary 

as  a function  of  the  system  state. 

The  plots  shown  were  generated  with  an  integration 
stepsize  of  2.0  seconds.  The  scales  for  these  plots  are 

Time  - Mission  time,  seconds. 

Longitude  - Radians. 

Latitude  - Radians, 

Altitude  - Feet. 

East  Velocity  - Feet/sec. 

North  Velocity  - Feet/sec. 
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Vertical  Velocity  - Feet/sec. 


Interpretation  of  Test  Results 

I 

The  two  types  of  plots  shown  are  to  be  interpreted  dif- 
ferently. The  plots  labeled  "FILTER"  show,  in  root-mean- 

1 

square  (rms)  form  the  covariance  computed  by  the  filter  for 
its  state  estimate.  The  primary  importance  of  this  covari- 
ance i nf orma ti on  is  its  use  in  comput i ng  the  Kalman  gain 
matrix.  If  the  computed  covariance  is  too  large,  the  gain 
will  be  larger  than  the  optimal  value,  causing  the  filter  to 
weight  the  measurement  information  too  heavily.  This  causes 
the  navigation  system  to  track  the  noise  in  the  measurements, 
and  to  fail  to  take  advantage  of  all  of  the  information 
available  in  its  own  state  estimate.  If  the  covariance  is 
too  small,  the  gain  will  be  smaller  than  optimal,  so  the 
filter  will  weight  the  propagated  state  estimate  too  heav- 
ily, If  the  covariance  becomes  excessively  small,  the  fil- 
ter will  ignore  the  external  measurements.  This  is  known 
as  filter  divergence,  since  it  allows  the  errors  in  the 
navigation  system  to  grow  without  bound.  Thus,  the  "FILTER" 
covariance  plots  have  only  an  indirect  meaning,  in  that  they 
influence  the  values  of  the  actual  errors  committed  by  the 
filter. 

The  more  directly  meaningful  plots  are  those  labeled 
"SYSTEM".  These  depict  the  rms  values  of  the  true  estima- 
tion errors,  calculated  by  6CAP  using  the  truth  model  sys- 
tem matrices  and  the  Kalman  gain  matrix  computed  by  the 
filter.  The  goal  of  Kalman  Filter  design  and  tuning  is  to 
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Figure  1.  Filter  I Estimated  Longitude  Error 
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Figure  3.  Filter  I Estimated  Latitude  Error 
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Figure  4.  Filter  I True  Latitude  Error 
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Figure  12.  Filter  I True  Vertical  Velocity  Error 
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Figure  14.  Filter  II  True  Longitude  Error 
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Fiqure  19.  Filter  II  Fs t tma ted  Fast  Velocity  Error 
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Figure  21.  Filter  II  Estimated  North  Velocity  Error 
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Figure  23.  Filter  II  Estimated  Vertical  Velocity  Error 
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Figure  24.  Filter  II  True  Vertical  Velocity  Error 
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Figure  27.  Filter  III  Estimated  Latitude  Error 


MICROCOPY  RCSOLUTION  TEST  CHART 

NAIWNAL  BURIAU  0»  STANDARDS  1%.T  A 


t.OO 


480.00 


510.00 


• 520.00 


490.00  500.00 

TIME  il0‘ 


Figure  32.  Filter  III  True  East  Velocity  Error 


Figure  33.  Filter  III  Estimated  North  Velocity  Error 
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Figure  34.  Filter  III  True  North  Velocity  Error 
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Figure  35.  Filter  III  Estimated  Vertical  Velocity  Error 
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Figure  37.  Filter  IV  Estimated  Longitude  Error 
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Figure  38.  Filter  IV  True  Lonaltude  Error 


LATITUDE  ERROR  - FILTER 

4 S 678910'*  2 3 4 6 678910'*  2 3 4 S6789J0'*  2 3 4 6 678? 


EAST  VELOCITY  ERROR  - FILTER 

3 4 5 6 753il0‘‘  2 3 4 5 6 78910°  2 3 4 5 6 78910 


470.00  480.00  490. OD  500.00  510.00  520.00 

TIME  «10^ 


Figure  44.  Filter  IV  True  East  Velocity  Error 
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Figure  46.  Filter  IV  True  North  Velocity  Error 
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minimize  these  errors.  Therefore,  a smaller  value  of  the 


"SYSTEM"  rms  errors  Indicates  better  filter  performance.  j 

The  data  shown  In  Figures  1 to  48  Indicates  that  there  I 

Is  very  little  difference  In  the  performances  of  the  four 

1 

filters  tested.  Most  of  the  plotted  lines  are  so  similar 
that  It  Is  difficult  to  distinguish  any  difference  at  all. 

In  testing,  they  can  be  compared  by  placing  one  directly 
over  the  other,  with  the  axes  aligned.  Since  that  method 
Is  not  practical  here,  the  actual  numbers  plotted  for  a 
typical  post-transient  time  point  are  listed  in  Table  VIII. 

The  data  produced  with  an  Integration  stepsize  of  0.2 
seconds  was  so  close  to  the  values  computed  for  a stepsize 
of  2 seconds  that  the  plots  are  Indistinguishable.  These 
error  values  are  listed  In  Table  IX.  Because  the  plots  are 
so  similar  to  Figures  1 to  48,  they  are  not  shown. 

Discussion  of  Results 

Figures  1 to  48  and  Table  VIII  show  that  there  Is  vir- 
tually no  difference  in  the  performances  of  the  proposed 
filters.  The  only  significant  differences  appear  in  the 
vertical  channels  Caltitude  and  vertical  velocity  errors). 

However,  the  vertical  channel  model  has  deficiencies  which 
place  these  results  in  doubt.  Myers  and  Butler  (Ref  2)  re- 
ported that  the  vertical  channel  model  used  for  this  study 
diverged  from  correct  state  estimation  for  a long  flight. 

For  the  shorter  flight  profile  of  this  study,  divergence 
did  not  occur.  However,  the  vertical  channel  model  Is  not 
considered  suitable  for  an  accurate  measurement  of  Kalman 
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Table  VIII 


Steady  State  RMS  Estimation  Errors  At  » 2.0  Seconds 


Component 

Type  I 

Type  II 

Type  III 

Type  IV 

Longitude 
( Radi ansxlO" 

3.58 

4.32 

3.42 

3.92 

) + 

3.53 

4.29 

3.41 

3.83 

Latitude 

« 

2.67 

2.70 

2.94 

2.76 

( Radi ansxlO" 

) + 

2.51 

2.55 

2.50 

2.59 

A1 t1 tude 

• 

47.9 

50.6 

50.4 

27.8 

( Feet) 

+ 

39.9 

42.9 

35.7 

24.7 

East  Velocity 

• 

.054 

.056 

.029 

.078 

( Feet/sec ) 

+ 

.010 

.010 

.010 

.010 

North  Velocity- 

.136 

.138 

.380 

. 145 

(Feet/sec) 

+ 

.010 

.010 

.009 

.009 

Vertical  Velocity 

- .084 

.262 

.349 

.063 

( Feet/sec ) 

+ 

.011 

.011 

.011 

.010 

NOTES; 

Indicates  the  error  prior  to  measurement  Incorporation. 


I 

+ Indicates  the  error  after  measurement  incorporation. 


Errors  listed  are  for  time  5098  seconds.  This  time  was 


selected  as  representative  of 

steady 

state 

performance . 

Longl tude : 

10’^ 

radians 

= 1.54 

feet 

(at  Lat=42.4°) 

Latitude: 

10"^ 

radians 

= 2.09 

feet 
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Table  IX 


r 

• I 


i 

1 


) 


Steady  State  RMS 

Estimation  Errors 

At  » 0.2 

seconds 

Component 

Type  I 

Type  II 

Type  III 

Type  IV 

Longitude  , - 

3.56 

4.20 

3.41 

3.91  ’ 

(Radians  xlO"M  + 

3.52 

4.18 

3.41 

3.83 

Latitude  - 

2.68 

2.71 

2.92 

2.76 

(Radians  xlO’M  + 

2.51 

2.55 

2.50 

2.60 

Altitude 

48.0 

52.0 

50.5 

26.8 

(Feet)  + 

39.6 

42.3 

35.6 

24.5  r 

East  Velocity 

.052 

.054 

.023 

.075  i 

(Feet/sec)  + 

.010 

.010 

.010 

.010 

North  Velocity  - 

. 130 

. 136 

.376 

. 139  1 

(Feet/sec)  + 

.010 

.010 

.009 

.009  [ 

Vertical  Velocity  - 

.076 

. 102 

.324 

.062  1 

(Feet/sec)  + 

.011 

.011 

.011 

.010  1 

See  notes  for  Table  VIII. 
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Filter  performance,  so  the  vertical  channel  results  were  not 
used  for  comparison  of  the  proposed  filters.  The  other  var- 
iables errors  in  East  and  iJorth  components  of  position  and 
velocity,  indicate  that  the  filters  are  achieving  almost 
identical  performance.  This  appears  to  contradict  the  ex- 
pectation of  a performance  gain  suggested  by  the  develop- 
ment of  Chapters  II  and  III.  Several  factors  which  could 
cause  this  result  must  be  considered. 

One  factor  is  that  the  ^ matrix  is  only  one  of  the 
parts  of  the  Kalman  Filter  model  which  significantly  affect 
estimation  accuracy.  From  equation  (17),  it  is  seen  that 
the  covariance  which  the  filter  estimates  and  uses  to  com- 
pute the  gain  matrix  is  driven  by  the  state  transition 
matrix,  well  as  the  driving  noise  matrix. 

If  the  driving  noise  is  small,  the  first  term  in  (17)  could 
dominate  the  computation.  Then  almost  any  form  of  a 0^ 
matrix  with  reasonably  accurate  tuning  would  produce  similar 
results  in  this  testing.  It  might  further  be  expected  that 
if  is  small  compared  to  making  the  terms  even 

smaller  would  have  little  effect  on  performance.  However, 
it  was  found  during  the  tuning  process  that  significant 
reduction  in  the  terms  caused  a severe  performance  degra- 
dation. Therefore,  the  idea  that  the  similarity  of  the  test 
results  stem  from  a lack  of  filter  performance  sensitivity 
to  the  proper  g^  values  can  be  rejected. 

Another  factor  is  that  the  filters  were  not  exhaus- 
tively fine-tuned,  as  mentioned  in  Chapter  I.  All  of  the 
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filters  were  tuned  until  further  tuning  efforts  appeared  to 
have  only  marginal  and  somewhat  ambiguous  effects.  However, 
there  Is  still  the  possibility  that  futher  refinements  In 
tuning  would  ultimately  give  one  of  the  filters  signifi- 
cantly better  performance  than  the  others.  The  tuning 
effort  was  extensive  enough  (approximately  120  tuning  runs) 
that  this  possibility  Is  judged  to  be  unlikely. 

A factor  that  appears  to  be  significant  in  these  re- 
sults Is  the  accuracy  of  the  measurements  available  from 
the  GPS  receiver.  In  the  model  used  (Appendix  A),  these 
measurements  are  modeled  as  range  and  range  rate  measure- 
ments from  each  of  four  satellites.  The  one-sigma  errors  of 
these  measurements  are  20  feet  for  range  and  0.1  foot/sec. 
for  range  rate.  The  combined  Information  from  four  such 
satellites  can  yield  measurements  of  even  greater  accuracy, 
depending  on  the  geometry  of  the  satellites  when  a measure- 
ment Is  taken.  For  example,  a single  observation  of  all 
four  satellites  measure  position  with  an  error  as  small  as 

— I I li  I II  • 10  feet 

As  long  as  the  Kalman  Filter  continues  to  run  without 
divergence  (I.e.,  without  reducing  the  gain  to  Ignore  ex- 
ternal measurements),  these  highly  accurate  measurements 
will  allow  It  to  have  small  errors  In  position  and  velocity. 
Even  when  the  gain  Is  substantially  different  from  the  opti- 
mal value,  the  errors  will  be  small.  Thus,  the  effect  of  a 
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better  matrix  in  more  accurately  calculating  the  gain 
matrix  produces  only  a very  small  benefit  in  reducing  the 
errors  in  the  filter. 

As  mentioned  in  Chapter  IV,  for  a small  Integration 
stepsize,  the  off-diagonal  terms  in  are  insignificant  in 
comparison  to  the  diagonal  terms.  It  is  possible  that  for 
an  integration  stepsize  of  2 seconds,  these  off-diagonal 
terms  are  still  not  extremely  significant,  and  thus  that 
they  make  little  difference  in  fiter  performance.  Also,  in 
the  Type  III  matrix,  the  off-diagonal  terms  are  computed 
directly  from  the  noise  values  of  the  2 'matrix  in  the  truth 
model  (see  Table  IV).  Then  pseudo-noises  are  added  to  the 
diagonal  terms.  These  pseudo-noises  may  be  substantially 
larger  than  the  true  noise  terms  from  which  the  correlated 
off-diagonal  terms  were  computed.  Thus,  the  off-diagonal 
terms  in  this  matrix  could  be  disproportionately  low,  so 
that  they  have  little  effect  on  performance. 

Conversely,  the  off-diagonal  terms  for  the  Type  II 
matrix  were  computed  with  the  correlation  factors  from  the 
Type  III  analysis,  but  using  the  pseudo-noise  values  of  the 
diagonal  terms.  This  could  possibly  make  the  off-diagonal 
terms  too  large,  i.e.,  it  might  be  more  appropriate  to  have 
only  some  of  the  pseudo-noise  appear  in  the  correlateu  terms. 
Provisions  were  made  in  the  covariance  analysis  program  to 
scale  the  off-diagonal  terms  by  an  arbitrary  factor,  in 
order  to  test  this  idea.  However,  this  testing  was  not 
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performed  due  to  time  limitations.  Thus,  the  possibility 
that  the  off-diagonal  terms  as  computed  were  too  large  or 
too  small  to  give  proper  results  must  be  considered. 

All  of  the  potential  reasons  given  so  far  for  the  test 
results  seen  in  Figures  1 to  48  and  Tables  VIII  and  IX  are 
at  least  possible,  and  some  must  be  considered  highly  prob- 
able. However,  there  is  another  factor  which  outweighs  all 
of  them.  This  effect  is  caused  by  the  way  in  which  the 
time  propagation  equation  for  the  covariance  is  computed 
(equation  (23))  is  used  in  GCAP,  but  equation  (12)  could  be 
used  instead).  The  computation  used  in  the  testing  for  this 
study  included  a partitioning  of  the  integration  interval, 
which  tended  to  mask  the  effects  of  off-diagonal  terms. 

To  see  this,  consider  how  ^(t)  is  propagated.  As  ex- 
plained in  Chapter  IV,  equation  (23)  cannot  be  used  directly, 
as  GCAP  would  normally  do.  Instead,  Q^(t)  is  set  to  zero, 
equation  (23)  is  integrated,  and  finally  is  added; 

P'(t+At)  = /J^'^hF(T)P(T)  + P(T)F' (r)  ]dT+^j(t  + At)  (24) 

Theoretically,  this  computation  should  be  performed  once 
for  the  interval  from  one  update  to  the  next.  However,  in 
GCAP  a Runge-Kutta  integration  technique  is  used,  which  is 
not  sufficiently  accurate  with  a stepsize  equal  to  the  typi- 
cal update  interval  of  approximately  10  seconds.  In  most 
on-line  Kalman  Filter  applications,  an  even  simpler  Euler 
integration  is  used  to  evaluate  equation  (24)  or  an  equiva- 
lent form  such  as  equation  (12).  Thus,  to  achieve 
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sufficient  numerical  accuracy,  the  Integration  stepsize  must 
be  reduced.  However,  there  Is  no  need  to  reduce  the  update 
interval . 

An  Integration  stepsize  smaller  than  the  update  Iner- 
val  Is  often  called  an  Integration  sub- Interva 1 . Using 
this  Idea,  equation  (24)  1s  evaluated  for  some  At,  smaller 
than  the  10  second  measurement  update  Interval,  which  gives 
accurate  numerical  Integration.  This  caluclation  Is  re- 
peated until  the  next  update  time  Is  reached,  then  a 
measurement  is  processed.  In  the  testing  for  this  study, 
the  update  Interval  was  set  at  10  seconds.  This  was  divided 
Into  5 sub- 1 nterva 1 s of  2 seconds  for  propagation  via  equa- 
tion (24). 

In  this  type  of  propagation,  the  matrix  will  be 
added  to  Intermediate  values  of  £.  Then  these  matrices 
will  be  used  In  the  integral  term  of  equation  (24).  If  the 
matrix  Is  assumed  to  be  diagonal,  the  diagonal  elements 
of  the  Intermediate  P matrices  will  be  directly  affected 
by  the  terms.  The  products  FP  and  PF^  will  generate  off- 
diagonal  terms  from  the  diagonal  elements  of  P.  Then  the 
Integral  term  of  equation  (24)  will  compute  off-diagonal 
terms  In  t'  j propagated  £ matrix  based  on  the  diagonal  ele- 
ments of  Thus,  the  effect  of  a diagonal  form  of 

added  at  each  sub-interval  Is  equivalent  to  the  effect  of  a 
full  matrix  (I.e.,  containing  off-diagonal  terms)  added 
only  at  the  last  sub-interval  before  a measurement  Incorpora 
tion. 
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This  effect  of  producing  off-diagonal  terms  In  £ from 
a diagonal  by  the  nature  of  the  Integration  used  appears 
to  be  the  most  significant  factor  In  the  lack  of  any  perfor- 
mance variation  among  the  filters  tested. 

Cone  1 us  1 on 

The  use  of  sub- Interva 1 s for  covariance  propagation  In 
Kalman  Filters  is  a common  technique.  The  results  of  this 
study  Indicate  that  this  technique  Is  appropriate  in  many 
cases.  Under  the  conditions  that 

1)  accurate  measurements  are  available  to  the  naviga- 
tion system 

2)  several  Integration  sub-intervals  are  used  for  co- 
variance  propagation, 

3)  a properly  tuned,  diagonal  form  of  ^ is  added  for 
each  sub- Interva 1 , 

the  testing  showed  that  the  estimation  results  are  compar- 
able to  the  results  obtainable  from  larger,  more  complex 
forms  of  the  matrix.  Since  most  Kalman  Filters  must  use 
the  sub-interval  technique  for  covariance  propagation  to 
achieve  sufficient  numerical  accuracy,  the  use  of  a compu- 
tationally advantageous  diagonal  state  noise  covariance 
matrix  Is  justified. 

Recommenda  ti ons 

The  alternate  forms  of  derived  for  this  study  could 
still  have  some  applicability  which  warrants  futher  investi- 
gation. Further  testing  should  be  performed  with  these 
forms  to  evaluate  the  effects  of  what  appear  to  be  the 
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major  factors  in  causing  the  observed  test  results.  In 
order  to  perform  this  testing,  it  is  recommended  that  the 
new  forms  of  the  truth  model  and  filter  model  designed  by 
Intermetrics  Incorporated  (Ref  6)  be  used.  This  would 
allow  analysis  of  vertical  channel  performance,  which 
appears  to  be  more  sensitive  to  variations  in  the  Kalman 
Filter  than  the  horizontal  channels. 

The  basic  variation  in  this  testing  would  be  a change 
in  the  method  used  for  covariance  propagation.  The  GCAP 
subroutine  which  performs  this  function  (INTEG)  was  modi- 
fied for  this  study  to  perform  the  evaluation  as  in  equa- 
tion (24)  rather  than  (23).  This  change  involved  elim- 
inating the  addition  of  ^(t)  in  the  ?(t)  equation  before 
integration,  and  adding  a subroutine  called  (IIJTQ)  to  add 
^j(t)  to  the  propagated  £(t)  matrix.  This  can  easily  be 
modified  to  add  Oj(t)  to  P(t)  only  for  the  last  integration 
step  before  a measurement  update.  In  order  to  evaluate  the 
matrix,  a value  of  At  is  needed.  In  the  testing  oer- 
formed.  At  was  set  equal  to  the  integration  stepsize.  For 
the  proposed  tests.  At  would  have  to  be  set  to  the  update 
interval,  since  the  matrix  must  represent  the  total  noise 
contribution  for  this  interval. 

These  changes  to  the  testing  configuration  will  almost 
certainly  require  retuning  of  the  proposed  Kalman  Filters. 

It  is  recommended  that  the  filters  be  retuned  and  tested  with 
these  changes  in  the  models  and  covariance  prooagation  equa- 
tions, but  with  the  other  test  parameters  the  same  as  in 
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this  study.  Also,  a filter  should  be  tested  with  a dia- 
gonal 3^  added  for  each  sub- i nterval , as  Type  I in  this 
study.  This  would  provide  a comparison  to  show  whether 
the  proposed  filters,  with  added  only  once  for  the  total 
propagation,  could  give  performance  equal  to  that  of  a 
standard  filter,  with  a diagonal  added  for  each  sub- 
i nterval . 

This  comparison  should  indicate  whether  equivalent 
performance  can  be  obtained  with  a less  frequent  addition 
of  a full  3^  matrix,  rather  than  a frequent  addition  of  a 
diagonal  0^  matrix.  If  this  is  true,  it  could  lead  to  a 
significant  savings  in  computations  for  an  on-line  Kalman 
Filter.  For  a typical  sub-interval  size  of  0.2  seconds, 
the  16  term  diagonal  3.(j  matrix  is  added  50  times,  for  a 
total  of  800  additions  for  the  3jj  term  of  the  covariance 
propagation  between  updates.  With  a 3.(j  matrix  containing 
off-diagonal  terms  added  once  per  measurement  sample  per- 
iod, such  as  Type  II  in  Chapter  III,  this  could  be  reduced 
to  30  additions,  while  adding  only  7 extra  words  of  storage 
space.  This  could  be  a substantial  savings  in  computation. 

The  effect  of  less  accurate  measurements  can  be  tested 
in  a very  straight  forward  way  by  simply  Increasing  the 
magnitude  of  the  terms  in  the  measurement  covariance  ma- 
trix, R.  With  this  change,  the  performance  of  the  Kalman 
Filter  would  rely  more  heavily  on  the  accuracy  of  the  inter 
nal  model.  Thus,  for  less  accurate  measurements,  a better 
evaluation  of  the  3(j  matrix  would  yield  a more  substantial 
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improvement  in  filter  performance  than  is  seen  when  highly 
accurate  external  measurements  are  available. 

The  off-diagonal  terms  generated  by  sub-interval  pro- 
pagation of  a diagonal  matrix  are  not  the  same  as  the 
off-diagonal  terms  in  the  Type  III  matrix.  The  Type  III 
matrix  contains  relatively  few  off-diagonal  terms  because 

\ 

I it  is  based  on  the  ^ matrix  from  the  truth  model.  This 

I matrix  has  only  four  noise  terms  directly  driving  the  states 

that  are  included  in  the  filter  model  (states  1-16).  When 
i equation  (24)  is  used  for  covariance  propagation,  all  16 

I states  have  driving  pseudo-noises,  so  many  more  off-dia- 

gonal terms  will  be  generated.  Another  matrix  could  be 
! derived  in  the  same  way  that  the  Type  III  matrix  was  derived, 

! but  with  the  pseudo-noises  included  in  states  1-16  of  the 

I ^ matrix  when  equation  (20)  is  evaluated.  The  filter  based 

] on  this  type  of  matrix  could  then  be  compared  with  one  in 

which  only  true  driving  noises  are  used  in  computing  off- 
diagonal  terms,  as  in  Type  III. 

Other  parameters  could  also  be  tested.  The  proposed 
filters  could  be  tested  using  a long,  low-dynamics  flight 
profile,  in  which  gyro  drifts,  Schuler  oscillations,  and 
other  long  term  effects  could  cause  problems.  The  effect 
I of  multiplying  the  off-diagonal  terms  in  the  derived  Q. 

matrices  by  a scale  factor  for  improved  tuning  could  be 
evaluated.  All  of  this  testing  could  lead  to  a more 
accurate  matrix,  which  could  reduce  the  computational 
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burden  of  the  Kalman  Filter  without  reducing  navigational 
accuracy . 


A limited  amount  of  additional  testing  suggested  In 
this  section  was  attempted.  The  only  change  made  for  this 
testing  was  to  add  only  for  the  last  integration  sug- 
Interval  before  an  update.  Runs  were  made  using  the  Type 
II  2^  matrix,  with  all  the  terms  In  Table  VI  multiplied  by 
5 to  account  for  the  longer  Interval  for  which  the  pseudo- 
noises simulated  the  effects  of  real  errors.  To  obtain 
good  performance,  this  filter  would  need  to  be  retuned,  but 
time  limitations  prevented  this. 

The  most  noticeable  change  in  the  results  in  this  test 
was  In  the  filter  covariance  propagation.  With  added 
for  each  sub- 1 nterva 1 , the  covariance  grows  quickly.  With 
added  only  for  the  last  sub- Interval  , the  covariance 
grows  more  slowly,  then  has  a step  increase  at  the  end  of 
the  propagation.  This  allows  the  effects  of  the  homogen- 
eous covariance  growth  and  the  added  covariance  to  be  dis- 
tinguished In  the  test  results. 

To  Illustrate  this.  Figures  49  and  50  show  an  expanded 
scale  for  the  filter  estimates  of  north  velocity  error.  In 
Figure  49,  was  added  for  each  sub-interval.  In  Figure 
50,  was  added  only  for  the  last  sub-interval.  Note  that 
the  plotter  interpolates  between  data  points.  The  dotted 
lines  In  Figure  50  show  how  the  covariance  would  actually 
propagate  for  small  Integration  steps.  This  would  be  fol- 
lowed by  a step  rise  In  the  covariance  when  added. 
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NORTH  VELOCITY  ERROR  - FI 


4720. DO  4740.00  4760.00  4780. CO  4G00.00  -4320.00 

TIME 

Figure  49.  Error  Growth  with  ^ Added  for  Each  Sub-Interval 
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If  ^ Is  added  only  for  the  last  sub-interval,  off- 
diagonal  terms  must  be  included  in  to  simulate  the  off- 
diagonal  terms  generated  by  a proper  evaluation  of  equation 
(23).  A Kalman  Filter  using  such  a matrix  shows  oromise 
of  giving  good  performance  with  slightly  more  storage  space 
and  considerably  less  computation  time  than  the  usual  form 
requi res . 

Summary 

The  test  results  presented  in  this  chapter  are  incon- 
clusive in  demonstrating  the  advantages  of  the  proposed 
state  noise  covariance  matrices.  They  indicate  that,  for 
the  type  of  sub-interval  propagation  equations  commonly 
used  in  Kalman  Filters,  the  usual  diagonal  form  of  0^  pro- 
vides performance  comparable  to  that  obtained  with  larger, 
more  complex  forms  of  Futher  testing  could  result  in 

an  improved  means  of  incorporating  driving  noise  into  the 
covariance  propagation.  This  method  would  involve  a 2^^ 
matrix  containing  off-diagonal  terms,  which  would  be  added 
only  once  for  a covariance  propagation.  Thus,  it  would 
significantly  reduce  the  number  of  filter  computations  re- 
quired, with  a modest  increase  in  computer  storage  space. 
This  change  could  be  found  to  have  little  or  no  adverse 
effect  on  filter  estimation  performance.  Moreover,  alter- 
nate forms  of  could  be  found  to  yield  significantly  en- 
hanced filter  performances  for  applications  in  which  the 
external  measurements  are  not  of  the  extremely  high  accuracy 
characteristic  of  GPS  measurements. 
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Thus,  for  many  practical  Kalman  Filter  applications, 
the  ideas  of  the  alternate  forms  of  discrete  time  state 
noise  covariance  matrices  discussed  in  this  study  appear 
to  be  a fruitful  area  for  continued  investigation. 
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Appendix  A 

Integrated  GPS/Inertial  Navigation  System  Models 

This  section  describes  the  truth  model  for  an  inte- 
grated GPS/Inertial  navigation  system.  It  also  describes 
the  reduced  order  model  on  which  a Kalman  Filter  is  based. 
These  models  were  used  in  the  testing  for  this  thesis.  The 
basic  truth  model  is  a 48-state  model  of  a baro-inertial 
navigation  system  using  a representative  inertial  navigation 
unit  in  the  1 nautical  mile/hour  class.  This  model  was  de- 
rived by  Widnall  and  Grundy  (Ref  1).  Myers  and  Butler  of 
the  Air  Force  Avionics  Laboratory  modified  this  model  by 
adding  the  necessary  user  clock  states  to  represent  a typi- 
cal Global  Positioning  System  (GPS)  receiver  (Ref  2).  The 
truth  model  contains  52  states,  of  which  the  first  16  are 
included  in  the  filter  model. 

The  models  are  described  in  terms  of  four  matrices;  f_. 

H,  and  R.  The  F_  matrix  is  derived  from  the  nonlinear 
homogeneous  state  differential  equation  for  the  system,  as 
in  equation  (2).  £ is  then  a linearized  matrix  describing 

the  homogeneous  error  state  behavior.  ^ is  the  matrix  of 
the  strengths  of  the  continuous  time  white,  Gaussian  noises 
which  drive  the  system.  H is  an  observation  geometry  matrix, 
as  used  in  equation  (4).  R is  the  measurement  covariance 
matrix,  which  describes  the  accuracy  of  the  measurement 
information  matrix. 

The  H matrix  used  in  testing  is  for  a single  instance 
of  receiver  and  satellite  geometry.  As  explained  in  Chapter 
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IV,  the  observation  geometry  was  assumed  to  remain  constant 
for  the  test  runs  in  this  study,  although  in  reality  this 
matrix  would  change  as  the  aircraft  and  satellites  moved. 
This  H matrix  was  generated  by  randomly  selecting  aircraft 
and  satellite  positions  and  using  a satellite  selection  rou- 
tine from  the  Integrated  GPS/Inertial  Simulation  Program 
(Ref  6).  The  H matrix  entries  are  identical  for  the  truth 
model  and  filter  model,  except  for  the  extra  zeroes  added  to 
the  truth  model  to  obtain  the  proper  dimension. 

The  £,  S.»  ii»  3nd  ^ matrices  are  listed  in  Tables  X to 
XIII.  Distinctions  between  the  truth  model  and  filter  model 
matrices  are  described  in  these  tables.  The  state  variables 
for  the  filter  and  truth  models  are  listed  in  Tables  I and 
II  of  Chapter  III. 


» 
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Table  X a 


a = 
Lat 
Lon 
h * 
V = 


F = 


£1  = 


0)  = 


'ALT 


tru 


£ Matrix  - Notation 

Wander  azimuth  angle  (radians) 

= Vehicle  Latitude  (radians) 

= Vehicle  Longitude  (radians) 

Vehicle  altitude  (feet) 

Vehicle  velocity  (feet/sec).  Components  iri  E-N-Z  (East- 
North-Up)  frame  shown  as  V^,  Vj^,  V^ 

Specific  force  vector.  Components  in  wander  azimuth 
frame  are  F , F^.  In  the  E-N-Z  frame, 

Fg  = -Fj^‘Sin(a)  - F^  cos*(a) 

■ ^y 

Earth  equatorial  radius  (feet) 

Angular  velocity  of  local  E-N-Z  coordinates  with  respect 
to  earth  (rad/sec) 

P£  = -V^/R 

P,  ^ V,/R 

Pz  * V^*tan(Lat)/R 

Earth  angular  rate  (rad/sec).  In  local  coordinates: 

= £J*cos(Lat) 

£1^  = £1*  si  n(  Lat) 

Angular  velocity  of  local  E-N-Z  coordinates  with  respect 
to  inertial  space  (rad/sec).  Components  are 

“E  ' "e 
“n  ■ 

- Pz'^^2 

Wjj  = u)g*co‘'(a)  + u)jj^’Sin(a) 

cjy  = -a)^*sin(a)  + a)|^*cos(a) 

ky,  = Damping  coefficients  for  baro- i nerti a 1 altitude 
^ channel 

D^m.  Dot  = Correlation  distances  of  gravity  deflections 
(feet) 

= Correlation  distance  of  altimeter  error  (feet) 

= Inverse  correlation  time  of  clock  random  frequency 
error  (1/sec)  2 

Vertical  component  of  gravity  (ft/sec  ) 
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Table  X b 

F Matrix  - Position  Errors 


Longitude  Error 

F(l,2)  - 

p^/cos{Lat) 

F(l,3)  - 

-Pj^j/(R*cos(Lat) ) 

F(l,4)  - 

l/(R«cos(Lat) ) 

Latitude  Error 

F(2.3)  - 

P^/R 

F(2,5)  > 

1/R 

Altitude  Error 

F(3,3)  - 

F(3,6)  =■ 

1 

F{3,10)  = 

kj*h 

F(3,47)  •= 
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Table  X c 

£ Matrix  - Horizontal  Velocity  Errors 
East  Velocity  Error 

■)  .1/  *<■>  .U  , 

N 'N' 


F(4,2) 

a 

F(4.3) 

- 

Pz’Pw'^Pn*Vz/R) 

F(4.4) 

a 

-(p^  tan(Lat)+V 

F(4.5) 

a 

F(4.6) 

a 

-(2*U|^^P|^) 

F(4,8) 

a 

-^z 

F(4.9) 

a 

F(4.35) 

a 

c 0 s ( a ) 

F(4.36) 

a 

- s 1 n ( It ) 

F(4.38) 

a 

Fj^*cos(oi) 

F{4.39) 

s 

-Fy* si n(a) 

F(4.41) 

a 

-(F^+G^) ‘cosla) 

F(4.42) 

a 

Fy  •cos(oi) 

F(4,43) 

a 

-(F^  + G^)  •sln(it) 

F(4.44) 

a 

f^*s1n(a) 

F(4,48) 

a 

1 

Veloci ty 

Error 

F(5.2) 

a 

-(2m2j^*Ve+Pn*Ve 

F{5.3) 

a 

‘■^N*'^Z''^E*'^Z^*^ 

F(5,4) 

a 

- 2 

F(5,5) 

a 

V^/R 

F(5.6) 

a 

F(5.7) 

a 

F(5.9) 

a 

F(5.35) 

a 

s 1 n { rt ) 

F(5,36) 

a 

cos(ct) 

F(5,38) 

a 

F^*s1n(oi) 

F(5.39) 

a 

Fy  •cos(oi) 

F{5.41) 

a 

-(F2+G2)*s1n(oi) 

F(5,42) 

a 

Fy  •sln(ct) 

F(5.43) 

a 

(Fz  + Gz^*^®^^'-''^ 

F(5.44) 

a 

-Fj^*cos(ct) 

F(5.49) 

a 

1 

/(cos(Lat)  )‘^) 
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Table  X d 

£ Matrix  - Vertical  Velocity  Error 
Vertical  Velocity  Error 


F(6.2) 

= 

-2.«z*Ve 

F(6,3) 

= 

2-Gz/R-xk2-(p^+P^) 

F(6,4) 

F(6,5) 

= 

-2-P£ 

F(6.7) 

F(6.8) 

= 

•^E 

F(6.10) 

= 

kz  • h 

F(6,ll) 

= 

-1 

F(6,37) 

= 

1 

F(6,40) 

= 

Fz+Gz 

F(6.45) 

F(6.46) 

= 

F(6.47) 

= 

k2 

F(6,50) 

= 

1 

127 


Table  X e 

F Matrix  - Tilt  Errors 


East  Axl s Tilt 

F(7,3)  = 

-Pr/R 

F(7,5)  - 

-1/R 

F(7.8)  = 

U)^ 

F(7.9)  = 

F(7.14)  = 

co5(a) 

F 7,15)  = 

-sin(a) 

F(7.17)  = 

F^*cos(a) 

F(7.18)  = 

Fy ‘COsCa) 

F(7.19)  = 

-Fy*s1n(a) 

F(7.20)  = 

-Fy*s1n(a) 

F(7.23)  = 

Fj^*Fy*cos(oi) 

F(7.24)  = 

-F^*Fy*sin(a) 

F(7,26)  = 

ii)^*cos(a) 

F(7.27)  = 

-0L)y*s1n(a) 

F(7,29)  = 

fl^*cos(a) 

F(7,30)  = 

-(jL)y*cos(a) 

F(7.31)  = 

n^*s1n(a) 

F(7.32)  = 

-u)^*s1n(a) 

North  Axis  Tilt 

F(8,21  - 

F(8.3)  = 

F(8,4)  = 

l/R 

F(8.7)  = 

F(8,14)  = 

s1n(a) 

F 8.15)  = 

cos(a) 

F(8,17)  = 

Fjj*s1n(a) 

F(8,18)  = 

Fy-sln(a) 

F(8,19)  = 

F^*cos(a) 

F(8.20)  = 

Fy*cos(a) 

F(8.23)  = 

F^«Fy*s1n(a) 

F(8,24)  = 

F^*Fy*cos(a) 

F(8.26)  = 

u)^*s1n(a) 

F(8,27)  = 

(Dy  • c 0 s ( a ) 

F(8,29)  * 

n^*s1n(a) 

F(8,30)  = 

-u)y  • s1n(a) 

F(8.31)  » 

-n^*cos(a) 

F(8.32)  » 

(jj^*cos(a) 
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Table  Xf 


£ Matrix  - Azimuth  Error 

Azimuth  Error 


F(9.2) 

= 

Wj^+p^xtandat) 

F(9,3) 

s 

-P^/R 

F(9,4) 

= 

tan(Lat)/R 

F(9.7) 

s 

F{9.8) 

= 

"‘"E 

F(9,16) 

a 

1 

F(9,21) 

a 

F(9.22) 

= 

Fz+Gz 

FC9,25) 

a 

F^-(Fz+Gz^ 

F(9.28) 

a 

F(9.33) 

= 

F(9.34) 

Table  X g 

£ Matrix  - Miscellaneous  Error  States 
Vertical  Acceleration  Error 


F(11.3)  = k3 

F(ll.lO)  = -k^.h 

F(11.47)  = -k3 

Clock  Phase  Error  ii 

F(12,13)  = 1 

F(12,52)  = 1 

Clock  Frequency  Error 
/ F(13.51)  = 1 

Baro-Al timeter  Error  Due  to  Variation  In  Altitude  of  a Con- 
stant Pressure  Surface 
F(47,47)  = -V/D^LT 
East  Deflection  of  Gravity 
F(48,48)  = -V/Dgg 
North  Deflection  of  Gravity 
F(49.49)  = -V/Dgj^ 

Gravity  Anomaly 


F(50,50)  = -V/Dg2 
Clock  Random  Frequency  Error 


Table  X h 


F Matrix  - Notes 


The  following  states  are  modeled  as  random  constants  or 
random  walks,  and  require  no  terms  In  the  £ matrix: 

State  Number  Description 


10 

Altimeter  Bias 

14-16 

6-1nsens1 t1 vte  gyro  drifts 

17-22 

G-sensItIve  gyro  drift  coefficients 

23-25 

G^-sens1t1ve  gyro  drift  coefficients 

26-28 

Gyro  scale  factor  errors 

29-74 

Gyro  Input  axis  misalignments 

35-37 

Accelerometer  Biases 

38-40 

Accelerometer  Scale  Factor  errors 

41-46 

Accelerometer  input  axis  misalignments 

51 

Clock  aging  bias 

i 

i 


I 

[ 


Values  of  Constant  parameters 

R = 20,  925,  639.76  feet 

£1  = 7.292115147  x 10“^  rad/sec 

XKl  = .03 

XK2  = .0003 

XK3  = 1 X 10‘® 

Dgg  = 60,761.15  feet 

Dgj^  = 60,761.15  feet 

Dg2  = 364,566.9  feet 

* 1,519,028.75  feet 

Btru  “ 1/(1800  sec) 

The  terms  listed  here  are  for  the  truth  model  £ matrix.  The 
filter  model  £ matrix  consists  of  all  listed  terms  for  which 
both  subscripts  are  less  than  or  equal  to  16. 
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Table  XI 
Matrix 


The  filter  model  matrices  are  derived  in  Chapter  II. 
For  the  truth  model,  a g^  matrix  is  used  to  depict  the 


driving  noises.  The  terms  listed  here  are  actually  terms 
of  GQG^,  in  order  to  show  which  state  is  driven  by  each  of 
the  noises. 


Q(12,12) 

Q(14.14) 

Q(15.15) 

Q(16.16) 

Q(35,35) 

Q(36,36) 

Q(37,37) 

Q(47,47) 

Q(48.48) 

Q(49,49) 

Q(50,50) 

Q(52,52) 


100  (ft^/sec) 

5.86  X 10"^®  ( (rad/sec )^/sec ) 
5.86  X 10"^®  (( rad/sec )^/sec ) 
1.62  X 10“^^  ((rad/sec)^/sec) 

2.88  X 10'^^  ((ft/sec^)^/sec) 

2.88  X 10’^^  ((ft/sec^)^/sec) 

2.88  X 10"^^  ((ft/sec^)^/sec) 
2.75  X 10'^  (ft^/sec) 

1.959  X 10'®  ( (ft/sec^)^/sec) 
8.375  X 10"^  ( (ft/sec^)^/sec) 
5.833  X 10“^  ((ft/sec^)^/sec) 
2.77  X 10"^®  C(ft/sec)^/sec) 


Note:  As  described  in  Reference  6,  the  noise  terms  for 
states  47-50  and  52  vary  with  velocity.  However,  the 
PR0F6EN  program  keeps  the  path  velocity  constant  throughout 
the  flight  profile  described  in  Chapter  IV.  Therefore,  the 
terms  shown  here  were  precomputed  for  the  entire  flight  pro- 
file. 


Table  XII  a 


P 


Matrix  - Notation 

Each  observation  provides  range  and  range  rate  measure- 
ments to  each  of  four  satellites.  Measurement  indices  are: 
k * satellite  number  (1-4) 

i  = range  measurement  to  satellite  k (i*2*k-l) 
j * range  rate  measurement  to  satellite  k (j=2*k) 

Other  notation: 

R(k)  = computed  range  to  satellite  k (feet) 
ft(k)  = computed  range  rate  to  satellite  k (ft/sec) 

R’  = range,  receiver  to  earth  center  (feet) 

R^(A^,K)  = Range  unit  vecotrs  receiver  to  satellite  k 

n Pi  recti  on 

1 East 

2 North 

3 Up 

fty(n,k)  * Range  rate  unit  vectors,  reciever  to  satellite 
k 

n^  Pi  recti  on 

1 East 

2 North 

3 Up 

L - Receiver  Latitude 

Ve,V|^,Vz  “ Components  of  receiver  velocity  (ft/sec) 
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Table  XII  b , 

H Matrix  - Equations  i 

i 

Range  Measurements 

H(1,l)  = Ry(l.k)-R'.cos{L)  1 

H(1,2)  = Ry(2,k)-R' 

H(1,3)  = Ry(3,k) 

HCl.lO)  = 1 

Range  Rate  Measurements 

= [fty(l,k)-RyCl.k)*(ft/R)-R'  j 

+ Ry(l,k)-V2-Ry(3,k).V£]*cos(L)  I 

+ IRu(2.k)-V£-Ry(l,k)-V,^]-s1nCL) 

H(J,2)  = lfty(2,k)-Ry(2,k)]-(ft/R).R' 

+ Ru(2,k)-V2-Ry(3,k)-V^ 

HCJ,3)  = lfty(3.k).R^^(3,k)]*Cft/R)  i 

H(J,4)  » R (l.k) 

H(J.5)  = Ry{2.k) 

H(J,6)  = Ry(3.k) 

= 1 
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Table  XII  c 


H Matrix  - Evaluation 

These  H matrix  terms  were  precomputed  and  used  through- 
out the  flight  profile 

Satellite 


Number ( k ) 

1 

2 

3 

4 

H(i.l) 

-1,284,390 

-14,067,800 

673,388 

8,891  ,740 

H(i ,2) 

-18,531,100 

9,958,820 

10,195,300 

13,474,300 

H(i ,3) 

.458117 

.254804 

.872353 

.549816 

H(i .10) 

1 

1 

1 

1 

H(j.l) 

77.8105 

-1227.55 

2179.51 

-272.222 

H(j,2) 

1442.71 

-2215.39 

-1333.22 

2028.61 

H(j.3) 

. 12888X10“^ 

-.276022X10"^ 

.322484X10"'^ 

-.916360X10 

H(j.4) 

-.076854 

-.841773 

.0402936 

. 532056 

H(j,5) 

-.885563 

.475912 

.487213 

.643909 

H(j.6) 

.458117 

.254804 

1 

.872353 

.549816 

1 

1 

1 

1 

1=2*k-l 
j = 2-k 


Table  XIII 


I 

i 

! 


R 

Matri x 

R(1.i) 

Covariance  of 

Range  measurement  if  i 

is  even. 

= 

Covariance  of 

Range  Rate  measurement 

i f i is 

R(l.l) 

= 

400 

(feet)^ 

R(2.2) 

= 

.01 

(ft/sec)^ 

R(3.3) 

= 

400 

(feet)^ 

R(4.4) 

= 

.01 

(f t/sec)^ 

R(5,5) 

= 

400 

( feet)^ 

R(6,6) 

= 

.01 

(f t/sec)^ 

R(7,7) 

= 

400 

( feet)^ 

R(8.8) 

= 

.01 

(ft/sec)^ 

The  R matrices  for  the  truth  model  and  filter  model  are 
i denti cal . 
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